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management  system  that  is  receiving  Inputs  from  a  large  number  of  widely  distributed  friatform/ 
sensors.  The  model  consists  of  two  basic  parts:  a  stimulator  and  a  track  correlation/aas^ation  module. 
The  stimulator  produces  noisy  detections  ftom  an  Input  scenario.  Hie  detections  from  each  platform 
are  subjected  to  a  correlation /association  process  and  the  detections  whidi  associate  with  existing 
tracks  are  integrated  with  selected  detections  from  other  platforms  to  produce  updated  position 
estimates  of  system  tracks. 
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MULTIPLE  PLATFORM  SENSOR  INTEGRATION  MODEL: 
MULSIM  COMPUTER  PROGRAM 


1.  INTRODUCTION 
1.1  Background 

The  Navy  has  always  been  interested  in  developing  the  means  to  effectively  integrate 
the  activities  of  individual  units  engaged  in  multiunit  operations.  Efforts  in  this  direction  led 
to  the  development  of  the  Navy  Tactical  Data  System  (NTDS),  which  is  basically  a 
computer-aided  manual  system.  Since  its  development  in  the  ISSOs  there  have  l^n  major 
technological  improvements.  These  developments,  together  with  improved  communications 
systems  such  as  Ae  Joint  Tactical  Information  Distribution  System  (JTIDS),  and  navigation 
satellites  such  as  NAVSTAR  have  brou^t  the  automatic,  multiple-platform  sensor 
integration  system  into  the  realm  of  possibility. 

The  system  that  has  been  modeled  consists  of  two  or  more  ships,  each  having  one  or 
more  radar/ESM  systems  on  board  (see  Fig.  1.1).  The  siurveillance  systems  are  assumed  to  be 
detecting  targets  either  on  an  individual  basis  or  jointly  with  other  surveillance  systems.  A 
communication  system  with  capabilities  similar  to  JTIDS  and  a  navigation  system  ci4>able  of 
giving  accurate  fixes  on  all  participating  platforms  are  assumed  to  exist.  The  combined 
system  has  the  ability  to  transmit  and  assimilate  data  and  provide  smoothed  tracking 
information  to  all  participating  platforms. 
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From  a  global  point  of  view,  the  most  obvious  benefit  to  be  derived  from  the  devriop- 
ment  of  this  system  is  the  presentation  of  the  overall  tactical  environment  to  Fleet 
commanders.  System  survivability  is  an  important  feature.  Platforms  will  still  be  able  to 
operate  with  tracking  information  from  other  platforms  in  the  event  that  their  suiveillanoe 
^sterns  become  inoperable  or  are  shut  down  in  EMCX)N  situations.  The  effects  of  stand-off 
main-lobe  jammers  can  also  be  mifiimigorf  shown  in  Fig.  1.2.  More  fundamental,  however 
are  the  benefits  to  be  derived  in  track  managunent.  Improved  tracking  performance  can  be 
expected  from  frequent  updates  that  occur  when  several  sensors  are  pr^ucing  detections 
and  from  increased  accuracy  produced  by  the  cross  hairing  of  targets  (see  Fig.  1.3). 


Fig.  1.3  —  Effects  of  cross-hairng 
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There  are  two  reasons  for  developing  this  model.  The  primary  consideration  is  the 
development  of  a  system  architecture,*  i.e.,  actual  development  of  algorithms  and  tech¬ 
niques  for  track  correlation/association,  track  management,  and  updating  of  tracks.  This 
architecture  is  hinged  upon  the  concept  of  obtaining  the  best  target  information  from 
sensors  while  using  the  smidlest  amount  of  channel  capacity.  The  second  conridecation  is 
having  the  cs4;>ability  of  examining  the  performance  of  the  system,  in  particular  the 
propagation  of  errors  through  the  system. 

To  reiterate,  the  model  will  serve  as  a  foundation  for  future  software  development  and 
at  the  same  time  allow  the  user  to  demonstrate  the  advantages/limitations  inherent  in  a 
multiple  platform  sensor  integration  system. 


1.2  Model  Architecture 

The  model  consists  of  two  basic  parts:  a  stimulator  and  a  track  correlation/integration 
system  (Fig.  1.4).  The  stimulator  takes  initial  target  positions,  headings,  and  velocities  from 
an  input  scenario  and  determines  their  position  at  some  later  time  designated  by  a  radar 
sector  crossing.  It  then  adds  measurement  errors  to  the  true  coordinates  of  the  radar  detec¬ 
tions  and  inputs  them  to  the  track  correlation/integration  module.  The  detections  from  each 
individual  platform  are  subjected  to  a  correlation/association  process,  and  the  detections 
that  associate  with  existing  tracks  are  integrated  with  selected  detections  from  the  other 
platforms  to  produce  updated  positions  for  the  system  tracks.f  The  stimulator  and  the  track 
correlation/integration  system  are  controlled  and  linked  by  the  executive  routine.  The 
executive  routine  also  controls  the  initiation  process  and  the  loading  of  track  files. 


System 

Tracks 


Fig.  1.4  —  Basic  modules 


*See  Refs.  1  and  2  for  a  more  detailed  discussion  of  system  architecture  and  operating  philosophy. 
tSee  Refs.  1  and  4  for  sample  tracking  outputs  from  MULSIM. 
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2.0  MULSIM  PROGRAM 

2.1  Executive  Module 

The  executive  module  has  four  basic  functions:  (a)  to  read  the  prc^ram  inputs  and  initial¬ 
ize  the  scenario,  (b)  to  load  the  system  track  files,  (c)  to  schedule  events  and,  (d)  to  call  the 
various  subroutines  in  a  logical  sequence  that  simulates  the  functional  flow  of  an  operating 
system.  These  functions  are  handled  by  subroutines  INITAL,  LOAD,  and  NEXRAO  and  the 
executive  routine,  respectively. 

2.1.1  MULSIM  Executive  Routine 

The  executive  routine  drives  the  MULSIM  program.  Besides  calling  for  the  initialization 
of  the  scenario  and  the  loading  of  the  track  files,  the  executive  routine  calls  each  subroutine, 
in  a  logical  sequence,  whenever  the  NEXRAD  subroutine  schedules  a  sector-crossing  event. 
This  procedure  can  best  be  followed  by  referring  to  Fig.  2.1. 

The  process  is  started  by  setting  the  game  time  equal  to  zero.  Subroutine  INITAL  is 
then  called  to  set  the  initial  values  of  scenario  parameters.  As  the  program  is  currently  con¬ 
figured  there  is  no  formal  input/output  (I/O)  structure.  Initial  positions  of  targets  and  ships 
and  parameters  relating  to  t^ectories  are  set  in  INITAL  on  a  card-by-card  basis,  i.e.,  there 
are  no  formatted  inputs. 

The  next  step  in  the  process  is  the  loading  of  the  sector  track  files  and  the  initialization 
of  the  tracking  filter.  The  positions  of  all  the  targets  and  ships  with  respect  to  each  ship  are 
determined  at  time  =  0  s  and  at  time  =  1  s  in  each  tiup’s  stabilized  coordinate  system  and 
deck-plane  coordinate  system.  The  subroutines  called  for  this  purpose  are  TRKGEN, 

SHPGEN,  MOTION,  SCOORD,  TCOORD  and  STABl.  Each  subroutine  is  described  in 
detail  in  the  track  correlation/integration  section. 

The  LOAD  subroutine  uses  the  generated  position  information  to  establish  target 
velocities  and  initialize  the  covariance  matrices  for  the  Kalman  filter.  LOAD  also  uses  the 
position  information  to  load  the  sector  track  files.  The  area  around  each  ship  is  divided  into 
64  angular  sectors,  and  target  tracks  are  assigned  to  sector  track  files  according  to  their 
current  location. 

When  the  loading  and  initialization  process  has  been  completed,  the  program  starts  to 
cycle  through  the  main  loop  of  the  routine.  The  program  exercises  this  loop  each  time  a 
radar  makes  a  sector  crossing.  The  time  at  which  a  sector  crossing  takes  place  and  the  sector 
number  of  the  sector  the  radar  has  just  crossed  is  determined  by  subroutine  NEXRAD.  If 
there  are  targets  in  the  sector  designated  by  NEXRAD  or  in  adjacent  sectors,  the  next  step  is 
to  update  the  position  of  all  targets  and  ships  to  the  sector  crossing  time.  Subroutines 
TRKGEN  and  SHPGEN  are  called  to  give  the  updated  latitude  and  longitude  of  all  the 
targets  and  ships,  and  tlie  ship’s  motion  is  accounted  for  by  calling  subroutine  MOTION, 
which  provides  the  current  pitch  and  roll  of  each  ship.  The  new  coordinates  of  all  the  targets 
and  ships  in  each  ship’s  stabilized  coordinate  system  are  found  by  calling  subroutines 
TCOORD  and  SCOORD. 


MUIiSIM  Executive  routine 
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The  targets  located  in  the  sector  designated  by  NEXRAO  are  identified  and  their 
numbers  are  loaded  into  detection  files.  Each  sector  is  fiirther  divided  into  range  bins  (200 
currently)  and,  corresponding  to  each  range  bin,  there  is  an  existing  detection  file.  The 
loading  of  these  detection  files  takes  place  in  subroutine  DETFIL. 

Before  the  coirelation/integration  process  can  be  attempted,  noise  must  be  added  to 
the  “true”  coordinates  of  the  targets  to  approximate  the  measurement  process.  This  is 
accomplished  by  first  transforming  the  stabilized  coordinates  to  deck-plane  coordinates*  in 
subroutine  STABl  and  then  injecting  noise  by  selecting  samples  from  a  normal  noise  distri¬ 
bution  derived  firom  a  random  number  generator.  This  function  is  performed  by  subroutine 
NOISY,  which  also  transforms  the  noisy  deck  plane  coordinates  back  to  the  stabilized 
coordinate  system.  All  of  the  correlation/inte^tion  process  is  carried  out  in  the  stabilized 
coordinate  system. 

There  is  one  additional  bookkeeping  function  performed  prior  to  the  correlation/ 
integration  process.  The  system  sector  track  files  must  be  kept  current.  Each  sector  has  a  file 
that  contains  all  of  the  tracks  currently  located  in  that  sector.  The  PREDIC  subroutine  is 
called  to  update  these  track  files  to  predict  the  position  of  the  tracks  at  the  sector  crossing 
time.  To  account  for  processing  delays  the  PREDIC  subroutine  is  applied,  not  to  the  tracks 
in  the  sector  designated  by  NEXRAD,  but  to  the  previous  sector.  An  additional  time  delay 
is  introduced  after  PREDIC  is  called  by  stepping  back  one  more  sector  before  starting  the 
correlation/integration  process. 

The  correlation  process  is  started  by  caUing  subroutine  CORRAS.  The  tracks  located  in 
the  sector  under  consideration  are  individually  selected  for  correlation  with  detections.  The 
detections  located  in  the  nine  range/sector  bins  contiguous  to  the  track  are  said  to  be  corre¬ 
lated  with  the  track,  and  the  statistical  distance  between  the  track  and  each  detection  is 
calculated. 

The  association  process  is  concerned  with  the  resolution  of  conflicts  that  might  arise  in 
the  correlation  process,  and  this  is  also  handled  in  the  CORRAS  subroutine.  Conflicts  occur 
when  two  or  more  tracks  are  correlated  with  the  same  detection.  If  this  is  the  case,  statisti¬ 
cal  distances  are  compared  and  the  detection  is  declared  to  be  associated  with  the  track 
having  the  smallest  statistical  distance  to  the  detection. 

The  next  step  is  to  sort  the  associated  detections.  SORT  subroutine  places  detections 
in  three  categories:  those  associated  with  participating  platforms;  those  associated  with 
tracks  that  one’s  own  ship  is  responsible  for  updating;  and  those  associated  with  tracks 
which  ownship  is  not  responsible  for  updating. 

Although  it  is  not  currently  being  done,  it  is  planned  eventually  to  use  those  detections 
in  the  first  category  for  reducing  bias  errors.  Positional  information  from  detections  in  the 
second  category  is  stored  for  the  updating  process,  and  if  the  detection  belongs  to  the  third 
category,  SORT  calls  subroutine  TIMCON  to  determine  if  a  time  slot  is  available  for 
transmitting  data  over  the  link. 


*See  Ref.  2  for  deacription  of  coordinate  systema. 
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The  executive  routine  is  also  concerned  with  the  flagging  of  time  slots.  The  status  of 
the  1-s  time  slots  over  a  1-min  period  is  taken  into  account.  This  1-min  period  is  divided 
into  segments  of  20  s  and  the  executive  routine  is  responsible  for  setting  the  flags  associ¬ 
ated  with  each  1-s  time  slot  in  the  segment.  At  20-s  intervals  the  executive  routine  sets  the 
flags  in  the  next  20-s  segment  to  0.  For  each  time  slot  this  indicates  that  no  data  have  been 
sent  over  the  link  during  that  1-s  period.  As  data  are  transmitted  the  corresponding  flags  are 
set  equal  to  1. 

The  LNKDET  subroutine  is  called  to  start  the  updating  process.  For  each  track  the 
LNKDET  subroutine  merges  the  detections  from  the  communications  link  with  those  from 
ownship  in  a  sequential  file. 

2.1.2  Subroutine  INITAL 

As  the  program  is  currently  configured  there  is  no  formal  input/output  structure.  Con¬ 
sequently  INITAL  is  used  to  define  the  scenarios,  set  parameters,  initialize  arrays,  and 
de^e  constants.  Table  2.1  defines  the  arrays,  parameters,  constants,  etc.  which  are  set  in 
INITAL.  Variables  are  listed  in  order  of  appearance. 


Table  2.1  —  Functions  Performed  in  INITAL 


Fortran 

Variable 

Description 

RAD 

Conversion  factor,  radians  to  degrees 

DIMl,  DIM2,  DIMS 

Dimensions  for  setting  size  of  arrays  in  KALMAN 

TIMLAG 

Time  lag  used  in  UPDATE 

LASDET 

Location  of  last  available  space  in  file  that  is  loaded  in 
DETLOC 

NEXDET 

Location  of  next  available  space  in  file  that  is  loaded  in 
DETLOC 

RNGDIM(I,J) 

Dimension  of  range  bin  in  meters  for  radar  I  on 
platform  J 

N(I) 

Standard  deviation  of  noise  in  measurement  of  targets 
and  position  of  platforms.  Used  to  determine  the  measure¬ 
ment  covariance  matrix  with  respect  to  platform  J  when 
measurement  is  made  at  platform  I. 

N2(I) 

Standard  deviations  of  noise  in  measurements,  used  to 
determine  covariance  matrix  with  respect  to  platform  I’s 
stabilized  coordinate  system 

SIGAZD(I,J) 

Standard  deviation  of  azimuth  measurement  noise  for 
radar  J  on  platform  I 

SIGELD(I,J) 

Standard  deviation  of  elevation  measurement  noise  for 
radar  J  on  platform  I 

GRINDLAY 


Table  2.1  (Continued)  —  Functions  Performed  in  INITAL 


Fortnm 

Variable 

Description 

RHOD(U) 

Standard  deviation  of  range  measurement  noise  for  radar 

J  on  platform  I 

LISDET(l) 

Linkage  device  used  in  DETLOC  to  reserve  and  vacate 
locations  in  files 

DETSC(I) 

Pointing  device  use  in  CORRAS  to  pinpoint  location  of 
last  entry  to  fUe 

FILEX(U) 

Pointing  device  used  in  SORT  to  pinpoint  location  of  last 
entry  to  file 

FILID(I) 

Linkage  device  used  in  SORT  to  link  aU  locations  in  a  file 
that  are  associated  with  a  particular  track 

NS 

Number  of  platforms  in  scenario 

AZINT(I,J) 

Initial  azimuth  of  radar  I  on  platform  J  (deg) 

RVEL(I,J) 

Rotation  rate  of  radar  I  on  platform  J  (deg/s) 

SILAT(I) 

Initial  latitude  of  platform  I  (deg) 

SILOG(I) 

Initial  longitude  of  platform  I  (deg) 

SIHT(I) 

Initial  hei^t  of  platform 

SVEL(I) 

Velocity  of  platform  I  (m/s) 

NR(I) 

Number  of  radars  on  platform 

NT 

Number  of  targets  in  scenario 

SECTIM(I,J) 

Time  required  by  radar  I  on  platform  J  to  sweep  over  one 
angular  sector 

TILAT(I) 

Initial  latitude  of  target  I  (deg) 

TILOG(I) 

Initial  longiti^de  of  target  I  (deg) 

TIHT(I) 

Initial  height  of  target  I  (in.) 

SIHD(I) 

Initial  heading  of  platform  1  (deg) 

TIHD(I) 

Initial  heading  of  target  I  (deg) 

TVEL(I) 

Velocity  of  target  I  (m/s) 

ER 

Equatorial  radius  of  the  earth  (m) 

PR 

Polar  radius  of  the  earth  (m) 

TIV(I) 

Angular  velocity  of  target  I  on  great  circle  route  (rad/s) 

SIV(I) 

Angular  velocity  of  platform  on  great  circle  route  (rad/s) 

RMAG(I) 

Roll  magnitude  of  platform  I  (rad) 

PMAG(I) 

Pitch  magnitude  of  platform  I  (rad) 
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Table  2.1  (Concluded)  —  Functions  Performed  in  INITAL 


Fortran 

Variable 

Description 

WOR(I) 

Roll  rate  of  platform  I  (rad/s) 

WOP(I) 

Pitch  rate  of  platform  I  (rad/s) 

RPHAS£(I) 

Initial  roll  phase  angle  for  platform  I  (rad) 

PPHASE(I) 

Initial  pitch  phase  angle  for  platform  I  (rad) 

LASTM(I) 

Last  available  location  in  file  used  in  MPTFIL 

DPOPM(I) 

Indicator  used  in  MPTFIL 

FULLM(I) 

Number  of  available  locations  in  file  used  in  MPTFIL 

NEXTM(I) 

Next  available  location  in  file  used  in  MPTFIL 

LISTM(I,J) 

Linking  device  used  in  MPTFIL 

DROPD(I) 

Indicator  used  in  DUMFIL 

LASTD(I) 

Last  available  location  in  file  used  in  DUMFIL 

FULLD(I) 

Number  of  available  spaces  in  file  used  in  DUMFIL 

NEXTD(I) 

Next  available  space  in  file  used  in  DUMFIL 

LISTD(I,J) 

Linking  device  used  in  DUMFIL 

FULLNK 

Number  of  available  spaces  in  file  in  LNKLOC 

LASLNK 

Last  available  space  in  file  used  in  LNKLOC 

NEXLNK 

Next  available  space  in  file  used  in  LNKLOC 

LISLNK(I) 

Linking  device  used  in  LNKLOC 

G(I,J) 

Array  used  in  state  equation  in  KALMAN 

H(I,J) 

Array  used  in  observation  equation  in  KALMAN 

2.1.3  Subroutine  LOAD 

Subroutine  LOAD  is  called  twice  by  the  MULSIM  executive  routine.  Once  at  time  =  0  s 
and  once  at  time  =  1  s.  Positions  of  all  the  targets  and  platforms  with  respect  to  every  other 
platform  are  determined  at  time  =  0  s.  This  calculation  is  carried  out  with  the  true  taigeil 
platform  locations,  and  the  positions  are  determined  in  each  platform’s  stabilized  coordinate 
system.  The  position  coordinates  are  saved  for  the  next  pass  through  LOAD,  and  control  is 
returned  to  the  executive  routine.  On  ilie  second  pass  through  LOAD,  positions  are  again 
determined  at  time  =  1  s  and  velocity  estimates  are  made  from  the  pomtion  changes  over  the 
1-s  time  interval.  This  information  is  used  to  load  the  estimated  state  vector  for  the  tracking 
filter. 

LOAD  next  calls  the  STAB2  subroutine  for  noisy  deck-plane  position  coordinates  that 
are  used  in  subroutine  COVOWN  to  determine  initial  values  of  the  measurement  covariance 
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oiatrix.  These  values  are  used  in  turn  to  load  the  covariance  matrix  that  correqmnds  to  tiie 
state  vector  estimate.  In  lieu  of  a  track>initiation  process,  LOAD  is  also  used  to  assign  MPT 
and  dummy  track  numbers  and  to  load  the  sector  files.  It  is  also  used  to  initialize  the 
NEXSEC,  TIMNEX,  and  TLAST  arriQrs.  The  NEXSEC  and  TIMNEX  arrays  contain  the 
number  of  the  sector  that  each  radar  wiU  next  cross  and  the  time  at  which  this  sector  cross- 
ing  will  take  place.  The  TLAST  array  contains  the  time  at  which  each  track  was  last 
updat'^d.  InitiaUy  all  the  elements  of  TLAST  are  set  equal  to  1  s. 

The  entire  process  is  outlined  by  a  macro  flowchart  in  Fig.  2.2. 

2.1.4  Subroutine  NEXRAD 

Subroutine  NEXRAD  is  called  by  the  Program  MAIN.  Its  primary  function  is  to  deter¬ 
mine  which  radar  on  which  platform  will  next  make  a  sector  crossing  and  then  record  the 
time  at  which  this  event  will  take  place. 

The  area  surrounding  each  ship  is  divided  into  64  angular  sectors.  The  sectors  are 
numbered  clockwise  firom  true  North  with  the  first  sector  to  the  ri^t  of  North  being 
assigned  the  number  1. 

The  flow  of  logic  through  the  subroutine  is  outlined  in  Fig.  2.3.  The  TIMNEX(I,J) 
array  contains  the  time  at  which  radar  I  on  platform  J  will  next  make  a  sector  crossing. 
NEXRAD  interrogates  this  file  for  the  lowest  time.  This  determines  which  radar  will  be  the 
first  to  make  a  sector  crossing.  The  sector  number  of  the  sector  that  radar  I  is  currently 
scanning  is  stored  in  the  NEXSEC(I,J)  file.  This  number  is  incremented  when  radar  I  on 
platform  J  has  the  lowest  value  in  the  TIMNEX  file.  The  TMRK(ISEC,I,J)  fUe  is  also 
updated  in  NEXRAD.  This  file  records  the  time  at  which  radar  I  on  ship  J  crossed  from 
sector  ISEC  to  ISEC-^l.  Before  leaving  NEXRAD,  TIMNEX(I,J)  is  also  increased  by  the  time 
required  by  radar  I  to  sweep  across  a  sector. 


2.2  SYSTEM  STIMULATOR 
2.2.1  Subroutine  MOTION 

Subroutine  MOTION  is  called  by  the  executive  routine  (MAIN).  For  a  given  time, 
MOTION  calculates  the  current  roll  and  pitch  of  each  platform.  The  roll  and  pitch  of  each 
platform  are  assumed  to  be  time-varying  sinusoidal  functions  with  specified  initial  values, 
magnitudes,  and  frequencies.  Table  2.2  defines  the  variables  used  in  MOTION. 
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Rg.  2.2  —  Subroutine  LOAD  macro  flowchart 
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Noisy  deck-plane 
coordinates 


Measurement  covariance 
matrix 


Fig.  2.2  (Concluded)  ~  Subroutine  LOAD  macro  flowchart 
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CHI) 


h 

I  K-1 

I  L  =  1 

SAVTIME 

»  100000 

F  1 

DO  20  J  =  1,  NS 
JNR  =  NRU) 
DO  20  I  =  1,  JNR 


K  =  I 
L  =J 

SAVTIM  =  TIMNEX II,  J) 


20 


ISEC  =  NEXSEC  (K.  L) 

IB  =  K 
IS  =  L 

NEXSEC  IK,  LI  =  NEXSEC  IK.  LI 


Set  up  do-loop  on  platform 
and  radars  to  determine 
which  radar  will  next  cross 
a  sector 


Time  of  next  sector  crossing 
>  SAVTIM? 


End  of  do-loop 


TMBK  (ISEC.  K,  L)  =  TIMNEX  IK,  L) 
TIMNEX  IK,  Lt  =  TIMNEX  IK,  L)  +  5ECTIM  IK  L) 
TIME  =  SAVTIM 


RETURN 


D 


Fig.  2.3  -  Subroutine  NEXRAJ) 
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Table  2.2  —  Variables  in  Subroutine  MOTION 


Fortran 

Variable 

Description 

TIME 

Time  (a) 

NS 

Number  of  platforms  in  scenario 

ARG 

Roll  or  pitch  for  unit  magnitude 

WOR(I) 

Angular  roll  frequency  for  platform  I  (rad/s) 

RPHASE(I) 

Initial  roll  for  ship  I  (rad) 

ROLL(I) 

Current  roll  position  for  platform  I  (deg) 

RMAG(I) 

Magnitude  of  roll  for  platform  I  (deg) 

WOP(I) 

Angular  pitch  fitequency  for  platform  I  (rad/s 

PPHASE(I) 

Initial  pitch  for  platform  I  (rad) 

PITCH(I) 

Current  pitch  position  for  platform  I  (deg) 

2.2.2  Subroutine  8HPGEN 

Subroutine  SHPGEN  determines  the  current  latitude,  longitude,  and  heading  of  all 
platforms  in  the  scenario  from  current  positions  and  velocities.  As  the  program  is  currently 
cpnfigured,  the  platforms  are  confined  to  moving  on  great  circle  routes  over  an  oblate 
spheroid  at  constant  speed.  The  platforms’  angular  velocity,  initial  heading,  latitude,  and 
longitude  are  provided  by  INITAL.  This  reduces  the  problem  to  a  simple  exercise  in  spheri¬ 
cal  trigonometry.  Almost  50%  of  the  logic  in  the  subroutine  is  concerned  with  resolving 
problems  encountered  at  trigonometric  discontinuities  (±  90°,  180°,  360°  etc.).  Table  2.3 
defines  the  variables  used  in  SHPGEN.  They  are  listed  in  the  order  of  their  appearance  in  the 
pr<%ram  listing. 


Table  2.3  —  Variables  in  SHPGEN 


Fortran 

Variable 

Description 

SIV(l) 

Angular  velocity  of  platform  1  on  great  circle  route 
(rad/s) 

TIME 

Time  (s) 

C 

Central  angle  transcribed  by  platform  under 
consideration 

YP 

Sine  of  central  angle 

ZP 

Cosine  of  central  angle 

SIHD(I) 

Initial  heading  of  platform  I  measured  from  true  North 

(deg) 
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Table  2.3  (Concluded)  -  Variables  in  SHPGEN 


Fortran 

Variable 

Description 

SILAT(I) 

Initial  latitude  of  platform  I  (deg) 

SILCX}(I) 

Initial  longitude  of  platform  I  (deg) 

XG,YG,ZG 

Direction  cosines  of  platform’s  current  position  in  geo¬ 
centric  coordinate  system 

SLAT(I) 

Current  latitude  of  platform  I  (deg) 

SLOG(I) 

Current  longitude  of  platform  I  (deg) 

SIHT(I) 

Initial  hei^t  of  platform  1  (m) 

SHT(I) 

Current  hei^t  of  platform  I  (m) 

SHD(I) 

Current  heading  of  platform  I  (deg) 

2.2.3  Subroutine  TRKGEN 

Subroutine  TRKGEN  is  very  similar  to  subroutine  SHPGEN.  TRKGEN  performs  the 
same  function  for  targets  that  SHPGEN  performs  for  platforms.  The  current  latitude,  longi* 
tude,  and  heading  are  determined  for  all  targets  in  the  scenario.  The  targets  are  confined  to 
moving  on  great  circle  routes  at  constant  altitude  and  speed  over  an  oblate  spheroid.  The 
targets’  angular  velocity,  initial  heading,  latitude,  and  longitude  are  provided  by  INTTAL. 
Table  2.4  defines  the  variables  used  in  TRKGEN,  listed  in  the  order  of  their  appearance  in 
the  program  listing. 


Table  2.4  —  Variables  in  TRKGEN  Subroutine 


Fortran 

Variable 

Description 

Angular  velocity  of  target  I  on  great  circle  route  (rad/s) 

Time  (s) 

C 

Central  angle  transcribed  by  target  under  consideration 

YP 

Sine  of  central  angle 

ZP 

Cosine  of  central  angle 

TIHD(I) 

Initial  heading  of  target  I  measured  firom  true  north  (deg) 

TILAT(I) 

Initial  latitude  of  target  I  (deg) 

TILOG(I) 

Initial  longitude  of  target  I  (deg) 
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Table  2.4  (Concluded)  —  Variables  in  TRKGEN  Subroutine 


Fortran 

Variable 

Description 

XG,  YG,  ZG 

Direction  cosines  of  targets’  current  position  in  geo¬ 
centric  coordinate  system 

TLAT(I) 

Current  latitude  of  target  I  (deg) 

TLOG(I) 

Current  lont^tude  of  target  I  (d^) 

THT(I) 

Current  height  of  target  I  (m) 

THIT(I) 

Initial  heii^t  of  target  I  (m) 

THD(I) 

Cturent  heading  of  target  I  (deg) 

2.2.4  Subroutine  SCOORD 

The  current  range,  azimuth,  and  election  of  all  the  platforms  with  respect  to  a  speci¬ 
fied  platforms’  stabilized  coordinate  system  is  determined  by  subroutine  SCOORD.  The 
locally  stabilized  coordinate  systems  are  centered  at  each  platform’s  c.g.  with  the  z-azis 
pointed  upward  along  the  local  gravity  vector,  the  y-axis  pointed  toward  true  North,  and  the 
jc-axis  lying  due  east  (see  Fig.  2.4).  Azimuth  is  measured  clockwise  from  the  y-axis. 


Fig.  2.4  —  Locally  stabilized  coordinates 
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If  the  latitude,  loi^tude,  and  altitude  of  each  platform  are  known,  it  is  a  simple  ezer- 
ciae  in  qpherical  trigonometry  to  determine  the  stabilized  coordinates  of  each  platform  in 
some  other  platform’s  stabilized  coordinate  system  and  hence  the  respective  range,  azimuth, 
and  elevation.  The  variables  used  in  this  process  are  listed  in  Table  2.5  in  the  order  of  their 
appearance  in  the  program  listing. 


Table  2.5  —  Variables  in  SCOORD 


Fortran  . 

Variable 

Description 

NS 

Number  of  platforms  in  scenario 

NT 

Number  of  targets  in  scenario 

ISHIP 

Platform  under  consideration 

ER 

Equatorial  radius  (m) 

PR 

Polar  radius  (m) 

RAD 

Conversion  factor,  degrees  to  radians 

SLAT(I) 

Current  latitude  of  platform  I  (deg) 

RHOT 

Local  Earth  radius  at  platform  I  (m) 

RHOS 

Local  Earth  radius  at  platform  ISHQ*  (m) 

SLOG(I) 

Current  longitude  of  platform  (deg) 

X,Y,Z 

Geocentric  coordinates  of  platform  I 

XP,  YP,  ZP 

Stabilized  coordinates  of  platform  I  in  ISHIP’s  stabilized 
coordinate  qrstem 

AZ(K,J) 

Azimuth  of  platform  K  with  respect  to  platform  J  (deg) 

EL(K,J) 

Elevation  of  platform  K  with  respect  to  platform  J  (deg) 

RG(K,J) 

Range  of  platform  K  with  respect  to  platform  J  (m) 

ISEC 

Sector  containing  platform  K  in  platform  J’s  coordinate 
system 

KSEC(ISEC,J) 

Indicator  which  indicates  that  platform  J  has  a  target  in 
sector  ISEC 

SHT(J) 

Altitude  of  platform  J  (m) 

2.2.5  Subroutine  TCOORD 

Subroutine  TOOORD  essentially  parallels  subroutine  SCOORD;  i.e.,  the  range,  azi¬ 
muth,  and  elevation  of  all  targets  in  the  scenario  are  determined  in  a  specified  platform’s 
stabilized  coordinate  system.  The  variables  not  used  in  subroutine  SCOORD  are  given  in 
Table  2.6. 
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Table  2.6  -  Variables  Not  Used  in  S(XX}RD 


Fortran 

Variable 

Description 

TLAT(I) 

Current  latitude  of  target  I  (deg) 

TLOG(I) 

Current  longitude  of  target  I  (deg) 

THT(I) 

Current  altitude  of  target  I  (m) 

f 


2.2.6  Subroutine  DETFIL 

Subroutine  DETFIL  is  called  by  the  executive  routine  to  assign  detection  numbers  to 
targets  and  load  them  in  their  respective  range  bin  files.  Technically  speaking,  DETFIL  is 
not  part  of  the  stimulation  process.  In  an  operating  system  the  DETFIL  function  would  be 
performed  on  noisy  measurements  made  by  the  system;  however,  in  MULSIM  the  DETFIL 
function  is  performed  on  the  stabilized  true  target  positions.  This  was  done  to  eliminate 
problems  associated  with  targets  flying  along  sector  lines  and  hopping  from  one  sector  to 
the  other  as  noise  was  injected  into  their  measurements.  Since  the  DETFIL  subroutine  per¬ 
forms  its  operations  before  the  completion  of  the  stimulation  process,  it  has  been  incli;ded 
in  the  system  stimulator  section. 

Subroutine  DETFIL  is  called  for  a  specified  radar,  platform,  and  sector.  The  first  step 
in  the  process  is  to  determine  the  angular  limits  of  the  specified  sector  and  then  run  throu^ 
all  die  platforms  and  targets  in  the  scenario  to  see  if  they  lie  within  this  sector.  The  next 
step  is  to  determine  which  range  bin  contains  the  target  and  to  load  the  assigned  detection 
numbers  into  a  linked  file  that  contains  all  the  detection  numbers  assigned  to  each  individ¬ 
ual  range  bin.  Aside  from  determining  whether  the  target  under  consideration  has  moved 
into  the  sector  during  the  sector  crossing  time  and  zeroing  out  an  array  used  in  the  correla¬ 
tion  subroutine,  this  essentially  completes  the  process.  Table  2.7  describes  the  FORTRAN 
variables  used,  and  Fig.  2.5  is  a  flowchart  of  the  subroutine  logic. 


Table  2.7  -  Variables  in  DETFIL 


Fortran 

Variable 

Description 

IR,  IS,  ISEC 

Identification  numbers  of  radar,  ship,  and  sector  under 
consideration 

NT,  NS 

Number  of  targets  and  platforms  in  scenario 

LSTBIN(I,J,K,L) 

Array  containing  identification  number  of  last  target  to 
be  placed  in  linked  file  for  sector  I,  range  bin  J,  radar  K, 
and  platform  L 

AZLO 

Lower  boundary  of  sector  ISEC  (deg) 

AZHJ 

Upper  boundary  of  sector  ISEC  (deg) 
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Table  2.7  (Concluded)  —  Variables  in  DETFIL 


Fortran 

Variable 

Description 

AZ(I,J),  RG(I,J) 

Azimuth,  range  of  target/platform  I  wjr.t.  platfonn  J 
(deg) 

JRN 

Range  bin  identification  number 

IDET(IR,IS) 

File  containing  next-detection  identification  number  to 
be  assigned  by  radar  IR  on  platform  IS 

RNGDIM(IS.IR) 

Range  dimension  of  range  bins  for  radar  IR  on  platform 

IS 

IDTA(ID,  IR,  IS) 

File  whidr  links  detections  and  targets.  File  contains 
target/platform  number  that  corresponds  to  detection 

ID  from  radar  IR  on  platform  IS. 

ITAG(I,IR,IS4SEC) 

Indication  that  target  I  was  assigned  detection  number  in 
sector  ISEC 

LNKBIN(ID,IR,IS) 

Linking  device  that  links  all  the  detections  firom  a 
particular  range  bin  for  radar  IR  on  platform  IS 

TRATG(ID) 

Flag  that  indicates  that  detection  ID  has  been  correlated 
with  a  track 

2.2.7  Subroutine  STABl 

Subroutine  STABl  is  called  by  the  MULSIM  executive  routine.  Its  primary  purpose  is 
to  produce  the  deck-plane  coordinate  of  all  the  targets/platforms  in  the  deck-plane  coor¬ 
dinate  system  of  a  platform  (ISHIP)  which  is  designated  in  the  calling  sequence.  The  sub¬ 
routine  is  entered  with  the  stabilized  coordinates  and  the  current  roll  and  pitch  of  platform 
ISHIP.  With  this  information,  it  is  a  simple  trigonometric  exercise  to  rotate  the  stabilized 
coordinates  into  the  deck-phuie  system.  Table  2.S  lists  the  variables  used  in  STABl  in  the 
order  of  their  appearance  in  the  program  listing. 
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Table  2.8  —  Variables  in  STABl 


Fortran 

Variable 

Description 

NT 

Nmnber  of  targets  in  scenario 

NS 

Number  of  platforms  in  scenario 

ISHIP 

ROLL(J),  PITCH(J), 

Platform  under  consideration 

(SHD(J) 

Current  roll,  pitch,  and  heading  of  platform  J  (deg) 

AZCM),  EL(I.J) 

Ciurent  azimuth  and  elevation  of  target  I  in  platform  J’s 
stabilized  coordinate  Qrstem  (rad) 

XX(I,J),YY(I,J) 

Direction  cosines  of  target  I’s  position 

SS(I,J) 

Vector  in  platform  J’s  deck-plane  coordinate  system 

AZD(I,J),  ELD(I,J) 

Azimuth  and  elevation  of  target/platform  I  in  platform 

J’s  deck-plane  coordinate  system 

2.2.8  Subroutine  NOISY 

Subroutine  NOISY  is  called  by  the  MULSIM  executive  routine  to  provide  the  model 
with  the  noisy  stabilized  coordinates  of  every  detection  in  a  designated  radar  sector.  The 
first  step  in  the  process  is  to  go  throu^  each  range  bin  in  the  sector  and  select  individual 
detections  from  the  range  bin  under  consideration. 

If  there  are  detections  in  a  particular  range  bin,  the  next  step  is  to  identify  the  targets 
they  correspond  to  through  the  IDTA  array  and  load  the  XYZTRU  array  with  the  true  rec¬ 
tangular  stabilized  coordinates  for  future  reference.  This  is  more  or  less  preliminary  to  the 
primary  function  of  NOISY.  The  nucleus  of  NOISY  is  the  STAB2  subroutine.  Therein, 
samples  are  selected  from  a  normal  noise  distribution  derived  firom  a  random  number 
generator.  The  samples  are  then  added  to  the  deck-plane  coordinates,  and  the  noisy  deck- 
plane  coordinates  (range,  azimuth,  elevation)  are  tnmsformed  to  the  stabilized  coordinate 
system  and  returned  to  NOISY.  NOISY  next  takes  the  noisy  stabilized  range,  azimuth,  and 
elevation  and  determines  the  rectangular  coordinates  of  the  detection.  These  are  loaded  in 
the  XYZMS  file.  The  TMS  file,  which  contains  the  time  at  which  the  detection  was  made,  is 
loaded  with  the  sector-crossing  time.  This  process  is  repeated  until  all  of  the  detections  in 
sector  ISEC  have  been  considered. 

Table  2.9  describes  the  variables  used  in  NOISY  listed  in  the  order  of  their  appearance 
in  the  listing.  Figure  2.6  is  a  flowchart  of  file  subroutine. 
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ENTER 


ISEC  Ml 
NTS  = 
J 

=  ISEC  - 1 

NT  +  NS 
=  IS 

A2LO  =  5.625*  (ISEC 

71 

AZHI  =  5.625*  (ISEC  +  1) 

1 

DO  100 

1  =  1,  NTS 

yes 

JRN  =  RG(I,  J)/RNGDIM(IS.  IRI 

LNKBIN  (ID,  IR,  IS)  =  LSTBIN  (ISEC,  JRN,  IR,  IS) 
LSTBIN  (ISEC,  JRN,  IR,  IS)  =  ID 


100 


Zero  out  ITAG  array  for 
previous  sector 

^  RETURN  ^ 


Fig.  2,6  —  Subroutine  DETFIL 
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Table  2.9  —  Variables  in  NOISY 


Fortran 

Variable 

Description 

IR,  IS,  ISEC 

Radar,  platform,  and  sector  to  be  considered 

JRN 

Range  bin  number 

LSTBIN(I,J,K,L) 

Array  containing  identification  number  of  last  detection 
made  in  range  bin  J  of  sector  I  by  radar  K  on  platform  L 

IDTA(I,J,K) 

Array  containing  target  number  of  target  that  corre¬ 
sponds  to  detection  I,  made  by  radar  J  on  platform  K 

XYZTRU(I,J,K,L) 

True  rectangular  coordinates  of  detection  I,  made  by 
radar  K  on  platform  L 

J  =  1  x-coordinate 
=  2  y-coordinate 
=  3  z-coordinate 

RG(I,J),  AZ(IJ), 

Range,  azimuth,  elevation  of  target  I  with  respect  to  plat- 

EL(IJ) 

form  J  (m  and  rad).  Values  are  true  stabilized  before  call 
to  STABl;  noisy  afterwards. 

XYZMS(I,J,KL) 

Noisy  stabilized  rectangular  coordinates  of  detection  I 
made  by  radar  K  on  platform  L 

J  =  1  x-coordinate 
=  2  y-coordinate 
=  3  z-coordinate 

TMS(I,J,K) 

Time  at  which  detection  I  was  detected  by  radar  J  on 
platform  K 

TMRK(I,J,K) 

Time  at  which  radar  J  on  platform  K  passes  from  sector 

I  to  (I  +  1). 

LNKBIN(I,J,K) 

Linking  device  containing  number  of  the  detection  that 
was  made  prior  to  detection  I  and  is  in  the  same  range  bin 
as  detection  1.  J  and  K  represent  the  radar  and  platform 
number  respectively. 

2.2.9  Subroutine  STAB2 

Subroutine  STAB2  is  called  by  subroutine  NOISY  for  a  designated  target,  ship, 
and  radar.  Its  primary  function  is  to  inject  noise  into  the  true  deck-plane  range,  azi¬ 
muth,  and  elevation  and  to  transform  the  noisy  measurements  to  the  stabilized 
coordinate  system.  This  is  accomplished  by  selecting  samples  from  a  normal  noise  dis¬ 
tribution  derived  from  a  random  number  generator  (VRANF),  weighting  the  samples 
by  the  standard  deviation,  and  adding  the  result  to  the  true  deck-plane  range,  azimuth, 
and  elevation.  The  transformation  to  the  stabilized  coordinate  system  is  a  simple  3-axis 
rotation  involving  the  ship’s  roll,  pitch,  and  heading. 
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JRN  =  1,100 


ID  =  LSTBIN  IISEC,  JRN,  IR,  IS) 


Go  thru  all  raitge  bins 
in  ISEC 


Any  > 
targets  in  this 
.  range  bin  - 


Get  target  number  save 
true  rect.  coord. 


IT  =  IDIA  (ID,  IR,  IS) 
XYZTRU  (ID,  1,  IR,  IS)  * 
XYZTRU  (ID,  2,  IR,  IS)  = 
XYZTRU  (ID,  3,  IR,  IS)  * 

RG  (IT,  IS 
RG  (IT,  IS 
RG  (IT,  IS 

•SIN  (AZIIT,  IS))  ‘COS  (ELIIT,  IS)) 
•COS  (AX(IT.IS))  •COS  (EL(IT.IS)) 

)  •SIN  (ELIIT,  IS,)) 

Save  noisy  measurements 

CALL  STAB2  ^  Gel  noisy  stab,  range,  az 

XYZMS  (ID,  1,  IR,  IS)  = 
XYZMS  (ID,  2,  IR,  IS)  = 
XYZMS  (ID,  3,  IR.  IS)  = 

RG  (IT.  IS) 
RG  (IT.  IS) 
RG  (IT.  IS) 

•SIN  (AZ(IT.IS))  •COS  (ELIIT,  IS)) 
•COS  (AZIIT,  ISII  "COS  (EL(IT.IS)) 
•SIN  (ELIIT.IS)) 

IMS  (ID,  IR,  IS)  =  TMRK  IISEC,  IR,  IS) 
ID  LNKBIN  (ID,  IR,  IS) 


Any 

more  range 
bins 


Set  lime  of  detection 
Pick  out  next  detection 


Fig.  2.6  —  Subroutine  NOISY 
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Table  2.10  lists  the  variables  in  the  order  that  they  are  presented  in  the  luting. 


Table  2.10  —  Variables  in  STAB2 


Fortran 

Variable 

Description 

I.J,K 

Designated  ta^et,  platform,  and  radar 

AZR.,  £jLR 

Noisy  deck-plane  measurements  (rad) 

AZND(I,J,K)  ) 
ELND(I,J,K)  > 

RNND  (I,J,K)  ) 

Noisy  deck-plane  azimuth,  elevation,  and  range  measure¬ 
ments  for  target  I  as  measured  by  radar  K  on  platform  J 

ROLL(J),  PITCH(J) 

Current  roll  and  pitch  of  platform  J 

X,Y,Z 

Direction  cosines  of  target  in  stabilized  system  that  has 

X-axis  pointed  in  direction  of  ship’s  motion 

SHD(J) 

Current  heading  of  platform  J  (deg) 

AZ(I,J),  EL(I,J)  ) 
RG(I,J)  1 

Stabilized  azimuth,  elevation,  and  range  of  target  I  with 
respect  to  platform  J.  True  quantities  are  replaced  by 
noisy  quantities  in  these  arrays  before  leaving  STAB2. 

2.3  Track  Correlation/Integration  System 
2.3.1  Subroutine  PREDIC 

Subroutine  PREDIC  is  called  by  the  MULSIM  executive  routine.  Its  primary  purpose  is 
to  keep  the  sector  track  files  current;  i.e.,  when  a  target  changes  sectors  it  must  be  deleted 
from  &e  track  file  of  the  sector  it  has  just  left  and  added  to  the  sector  it  has  just  entered. 

Tracks  are  placed  in  track  files  according  to  the  sector  in  which  they  are  currently 
located.  For  example,  after  the  detections  from  sector  J  (see  Fig.  2.7)  are  placed  in  the 
appropriate  detection  files,  the  question  arises  as  to  which  tracks  are  candidates  for  correla¬ 
tion  witli  these  detections.  This  question  is  not  answered  immediately.  The  correlation 
process  takes  place  in  sector  (J-2)  to  account  for  delays  in  the  system.  However,  before 
attempting  the  correlation  process  an  intermediate  brokkeeping  step  is  required  to  keep  the 
sector  files  current.  The  pr^icted  positions  of  the  tracks  in  the  (J-1)  sectm:  file  at  the  (J-1) 
sector  crossing  time  are  determined  to  see  if  they  are  stiU  located  in  sector  (J-1).  Adjust¬ 
ments  are  made  to  the  sector  files  to  reflect  any  change  in  their  position  at  this  time. 

Each  ship  maintains  two  sector  track  files,  i.e.,  for  each  sector,  each  ship  maintains 
what  is  referred  to  as  a  dummy  track  file,*  which  is  used  for  local  purposes,  and  a  mult^le 
platform  track  (MPT)  file,  which  is  used  for  communicatii^  witii  other  ships  via  the  link. 


*The  dummy  flie  is  used  for  two  i«a>oiu:  (a)  becaute  there  may  be  tentative  tracks  that  have  not  gone  out 
over  the  link,  and  (b)  because  provisions  must  be  made  for  the  system  degrading  to  a  sin^e  unit. 
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Fig.  2.7  —  Locating  tracka  and  detections 


The  first  step  taken  by  PREOIC  in  this  process  is  to  interrogate  the  dummy  sector  file 
(DUMSX)  to  determine  if  there  are  any  tracks  in  sector  ISEC.  If  there  are  no  tracks,  control 
is  immediately  returned  to  tiie  executive  routine.  Otherwise  the  first  track  in  the  DUMSX 
file  is  examined  to  determine  if  it  is  a  track  fiiat  platform  IS  is  responsible  for  updating.  The 
X(I)  file  is  next  loaded  with  position  and  velocity  coordinates  from  the  XSM0(I,J,K) 
tracking  file.  For  those  tracks  that  come  from  o^er  platforms  the  position  coordinates  and 
velocity  components  are  run  throu^  the  appropriate  transformations  by  the  TRANSF  and 
VTRANS  subroutines. 

The  next  step  is  to  determine  the  predicted  position  of  the  track  at  a  time  correspond¬ 
ing  to  the  sector-crossing  time  (TMRK).  The  rectangular  coordinates  of  the  predicted  posi¬ 
tion  ate  stored  in  the  XYZOUM  array  and  the  predicted  range,  azimuth,  and  elevation  are 
stored  in  the  RAEOUM  array. 

The  bulk  of  the  remaining  logic  in  the  subroutine  is  concerned  with  determining  which 
sector  contains  the  predicted  track  position.  If  the  track  (NT)  remains  in  sector  ISEC,  no 
further  action  is  taken.  When  the  track  has  moved  to  a  new  sector,  subroutine  DUMDRP  is 
called  to  remove  it  from  sector  ISEC’s  track  fOe,  and  subroutine  DUMNEW  is  called  to  place 
it  in  the  track  file  of  the  new  sector.  This  process  is  repeated  until  all  the  tracks  in  sector 
ISEC  have  been  considered. 

Table  2.11  contains  the  variables  used  in  PREDIC  in  the  order  of  their  appearance  in 
the  program  listing. 
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Table  2.11  -  Variables  in  PREDIC 


For*'  an 

Vazuble 

Description 

ISEC,  IR,  IS 

The  sector,  radar,  and  platform  imder  consideration 

DUMSX(U) 

Array  containing  the  identification  number  of  the  last 
track  to  be  placed  in  sector  I  dummy  track  file  on 
platform  J 

TMRK(M,K) 

Sector-crossing  time;  i.e.,  the  time  at  which  radar  J  on 
platform  K  passes  from  sector  I  to  sector  I  +  1. 

TRKST(NT,IS) 

File  linking  dummy  tracks  and  MPT  tracks;  contains  the 

MPT  number  of  track  NT  from  platform  IS 

PTFST(NT,IS) 

File  containing  the  platform  number  of  the  platform  that 
is  responsible  for  updating  track  NT  from  platform  IS’s 
dummy  track  file. 

XSMO(I^T,KS) 

Smoothed  position  and  velocity  coordinates  of  track  MT 
that  reside  in  platform  KS’s  MPT  file 

I  - 1,  x-coordinate;  1  =  2,  x-coordinate 

=  3,  y-coordinate;  =  4,  y-coordinate 

=  5,  z-coordinate;  =  6,  z-coordinate 

XYZDUM(NT,I,IS) 

Predicted  rectangular  position  coordinates  of  track  NT 
from  platform  IS’s  dummy  file 

1  =  1,  x-coordinate 

=  2,  y-coordinate 

=  3,  z-coordinate 

RAEDUM(NT,I,IS) 

Predicted  range,  azimuth,  and  elevation  of  track  NT  with 
respect  to  platform  IS’s  stabilized  coordinate  system. 

1  =  1,  range 

=  2,  azimuth 

=  3,  elevation 

2.3.2  Subroutine  CORRAS 

2.3.2.1  Introduction 

Subroutine  CORRAS  is  called  by  the  MULSIM  executive  routine.  The  primary  purpose 
of  the  CORRAS  subroutine  is  to  identify  those  detections  from  a  designated  ladar/platform 
that  correlate  with  the  tracks  in  a  designated  sector  and  to  resolve  conflicts  that  mi^t  arise 
when  more  than  one  track  is  correlated  with  the  same  detection.  The  latter  function  is 
referred  to  as  the  association  process.  A  macro  flowchart  outlining  the  procedure  adopted  to 
correlate  and  associate  detections  Mrith  a  group  of  tracks  from  a  given  azimuth  sector  is 
shown  in  Fig.  2.8. 


26 


NRL  REPORT  S358 


ORINDLAY 


Basically  what  is  involved  in  the  conelation  process  is  the  selection  of  detections  in 
some  geometrical  area  surrounding  a  predicted  triu:k  location.  These  detections  are  then 
ordered  according  to  a  previously  de^ed  statistical  distance  to  the  track  under  considera' 
tion  and  are  stored  in  a  retrievable  file  for  use  in  the  association  process. 

The  association  process  is  concerned  with  resolving  conflicts  that  occur  during  correla¬ 
tion.  Conflicts  occur  when  two  or  more  tracks  have  the  same  detection  at  the  top  of  iheir 
detection  files.  The  association  process  resolves  these  conflicts  by  comparing  statistical 
distances. 

2.3.2.2  The  Correlation  Process 

The  actual  correlation  process  is  preceded  by  the  selection  and  location  of  tracks.  This 
is  detailed  in  Fig.  2.9.  The  track  number  (NT)  at  the  top  of  the  dummy  sector  file  is  selected 
to  begin  the  process.  The  range  bin  (JRNG)  that  contains  the  predicted  position  of  the  track 
is  then  determined,  and  this  is  used  to  correlate  the  track  with  detections  in  its  range- 
azimuth  bin  and  in  all  adjacent  range-azimuth  bins;  i.e.,  nine  range-azimuth  bins  in  all  are 
considered.  After  the  association  process  the  next  track  in  the  sector  dummy  file  is  selected 
and  the  process  is  repeated  until  there  are  no  tracks  left  to  be  considered  in  the  sector 
clutter  ffle  (NT  =  0). 

The  correlation  process  begins  by  considering  the  detections  located  in  azimuth-range 
bin  (I-l,  J-1).  See  Fig.  2.10.  The  detection  numbers  of  the  detections  firom  each  range- 
azimuth  bin  have  been  placed  in  linked  files.  The  first  detection  number  (IDETNO)  for  bin 
I,J  is  obtained  from  LSTBIN  (I,J,IRAD,ISH1P).  When  a  value  of  zero  is  obtained  from  this 
file,  it  is  an  indication  that  there  are  no  further  detections  to  be  considered  in  bin  I,J.  As 
each  detection  is  drawn  from  the  LNKBIN  fUe,  the  statistical  distance  between  the  detec¬ 
tion  and  the  track  under  consideration  is  determined  by  subroutine  COVOWN.  This  is  used 
to  order  the  detections  in  a  sequential  file  IRADET(J),  with  the  detection  number  having 
the  smallest  statistical  distance  placed  in  IRADET(l).  This  process  is  repeated  for  aU  adja¬ 
cent  bins  and  for  the  bin  that  contains  NT.  The  net  result  is  two  sequential  files: 

IRADET(J)  containing  the  ordered  detection  numbers  and  SDIST(J)  containing  the  ordered 
statistical  distances.  The  number  of  detections  (K)  correlating  with  NT  is  also  recorded.  The 
sequential  files  are  not  tagged  with  an  identifier  relating  them  to  NT  because  these  values 
will  be  placed  in  a  linked  file  during  the  association  process,  thereby  allowing  greater 
flexibility  in  retrieval  and  storage.  The  correlation  process  is  detailed  in  Fig.  2.9. 

2.3.2.3  The  Association  Process 

The  association  process  begins  with  placing  the  statistical  distances  and  detections, 
which  have  been  correlated  with  the  track  under  consideration,  in  linked  files.  The  detection 
numbers  are  placed  in  ISTOR(LOC)  and  the  statistical  distances  in  SD(LOC).  The  detections 
are  located  in  these  files  with  a  pointer  DETSX(IX>C).  This  gives  the  location  (LOG)  of  the 
correlated  detection  that  has  the  smallest  statistical  distance  to  the  track  under  considera¬ 
tion.  The  location  of  the  detection  with  the  smallest  statistical  distance  is  found  from  the 
link  DETID(LOC),  i.e.,  OETID(LOC)  contains  the  location  of  the  detection  that  follows  the 
one  fotmd  in  LOG.  As  detection  numbers  and  statistical  distances  are  fed  into  the  ISTOR 
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Ent«r  with  platform,  wctor 
and  radar 


~  ~  I  Salact  track  rK>.  at 

NT  -  DUMSX  (ISEC.  ISHIPl  top  of  factor  track 
— —  i—  —  ■■Ml  —  1. 1  fHa 


Yef.  There  are  no  more 
tracki  to  be  coneidered 


r  H 

'  RETURN  ] 

L 

Set  up  linked 
files  for  use 
in  association 
process 


JRNG  »  RAEOUM  (NT.  1,  ISHIPI/'RNGOIM  dSHIF.  iRAOl 


Select  next  detection 


IDETNO  «  LNKBIN  (IDETNO.  IRAD.  ISHIP) 


Pick  a  r>ew 
bin 


Carry  out  association 
process  for  rrack 
under  conskjeratior 


Select  a  new 
track 


lOETNO 

*.0 


NN 

-  K 

K  * 

K  +  1 

. 

f  CALL  COVOVVN  > 
I  (IRAD.  ISHIP,  IDETNO. 
V  NT,  SDI,  ISEC)  J 


SO>  ^ 
SDIST  U-tl 


>>0  ^  I  SDIST  (J  I  «  SDIST  IJ  - 1)  ' 

'I  IRADETIJI  -  IRADETIJ-U  I 


SDIST  U) »  SOI 
IRADETiJI  -  IDETNO 


f  ^ 

i  I 


Fig,  2.9  —  The  correlaUon  pirocew 
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and  SD  files,  locations  in  these  files  are  provided  by  the  NEWLOC  subroutine.  Flowcharts  of 
the  NEWLOC  subroutine  and  the  association  process  are  found  in  Figs.  2.11  and  2.12 
respectively. 


Fig.  2.11  —  Subroutine  NEWLOC 


After  the  correlated  detections  and  statistical  distances  have  been  placed  in  the  linked 
files,  it  is  possible  to  proceed  with  the  resolution  of  conflicts.  This  begins  with  the  selection 
of  the  first  detection  number  (IDETNO)  from  the  linked  file.  For  each  detection  there  is  a 
one-to-one  relationship  with  some  track.  This  is  established  throu^  the  use  of  the  TRATG 
file.  If  TRATG(IDETNO)  is  zero,  it  means  that  a  relationship  has  not  previously  been  estab¬ 
lished  between  lOETNO  and  some  track.  In  this  case  TRATG(IDETNO)  is  assigned  the 
value  NTA.  If  TRATG(IDETNO)  has  been  previously  assigned  another  track  number  (NTT), 
this  means  that  a  conflict  exists.  The  conflict  is  resolved  by  comparing  statistical  distances. 

If  the  statistical  distance  between  NTA  and  IDETNO  is  less  than  that  between  NTT  and 
IDETNO,  then  TRATG(IDETNO)  is  assigned  the  value  NTA,  and  the  next  detection  in  the 
linked  file  of  detections  that  correlated  with  NTT  is  examined  for  a  possible  conflict  with 
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other  tracks.  This  process  will  continue  until  a  one-to^ne  relationship  is  established 
between  a  track  and  a  detection  or  there  are  no  more  detections  left  in  a  linked  detection 
fUe.  If  the  statistical  distance  between  NTA  and  IDETNO  is  not  less  than  that  between  NTT 
and  IDETNO,  the  process  reverts  to  the  next  detection  in  the  linked  file  associated  with 
NTA  and  again  an  attempt  is  made  to  establish  a  one-to-one  relationship.  As  each  conflict  is 
resolved,  the  location  of  the  detection  which  correlated  with  the  track  having  the  larger 
statistical  distance  is  made  available  for  future  storage  in  the  ISTOR  and  the  SD  file.  This  is 
accomplished  by  calling  the  NEWLOC  subroutine  with  IDRP  set  equal  to  zero. 

When  all  tracks  in  the  designated  sector  have  been  correlated  with  the  given  detections 
and  all  conflicts  have  been  resolved,  the  process  is  complete. 

The  Fortran  variables  used  in  CORRAS  are  listed  in  Table  2.12. 


Table  2.12  —  Variables  in  CORRAS 


Fortran 

Variable 

Description 

ISHIP,  ISEC,  IRAD 

Platform,  sector,  and  radar  under  consideration 

DUMSX(I,J) 

Array  containing  the  trade  number  of  last  track  to  be 
plac^  in  platform  J’s  Ith  sector  file. 

DETSX(NT) 

Array  that  identifies  the  locations  in  the  ISTOR  and  SD 
files  that  contain  the  ID  number  and  the  statistical 
distance  to  tract  NT  of  the  detection  with  the  smallest 
statistical  distance  to  NT 

DETID(LOC) 

Linking  device  that  gives  the  location  of  detection  and 
statistical  distance  that  is  next  smaller  than  the  one  found 
in  LOG 

NT 

Track  number 

JRNG 

Range-bin  identifying  niunber 

RAEDUM(NT,I,K) 

Predicted  range  of  track  NT  from  platform  K’s  dummy 
track  file 

RNGDIMdSHIP, 

Range  dimension  assigned  to  range  bins  associated  with 

IRAD) 

radar  IRAD  on  platform  ISHIP 

LSTBIN(I,J,K,M) 

Array  containing  identification  number  of  last  detection 
made  in  range  bin  J  of  sector  I  by  radar  K  on  platform  M 

LNKBIN(I,JJC) 

Linking  device  containing  the  number  of  the  detection 
that  was  made  prior  to  detection  I  and  is  in  the  same 
range  bin  as  detection  I.  J  and  K  represent  the  radar  and 
platform  number,  respectively 
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Table  2.12  (Concluded)  —  Variables  in  CORRAS 


Fortran 

Variable 

Description 

SDIST(NN) 

Array  containing  statistical  distances  from  track  imder 
consideration  to  all  the  detections  that  are  correlated 
with  it.  SDIST(l)  is  smallest. 

IRADET(NN) 

Array  containing  detection  numbers  of  detections  that 
ate  correlated  with  track  under  consideration. 

IRADET(J)  corresponds  with  SDIST(J). 

DUMID(NT,ISHIP) 

Linking  device  containing  the  track  number  of  the  track 
that  was  placed  in  sector  track  file  prior  to  track  NT 

ISTOR(LOC) 

Linked  tile  containing  detection  numbers  of  correlated 
detections.  Similar  to  IRADET  temporary  file.  Accessed 
by  DETSX  pointer  and  DETID  linking  device. 

SD(LOC) 

Linked  tile  containing  statistical  distances  between 
detection  in  ISTOR  and  track  designated  by  DETSX. 

TRATG(ID) 

Flag  indicating  status  of  detection  ID 

TRATG(ID)  =  1;  detection  has  been  correlated  with 
some  track. 

TRATG(ID)  =  0;  detection  has  not  been  correlated 
with  any  track. 

IDRP 

Flag  for  subroutine  NEWLOC 

IDRP  =  1;  find  a  new  location 

IDRP  =  0;  vacate  location 

2.3.3  Subroutine  COVOWN 

Subroutine  COVOWN  is  called  by  subroutine  CORRAS.  Its  primary  purpose  is  to  pro¬ 
vide  the  KALMAN  subroutine  with  the  measurement  covariance  matrix  in  the  stabilized 
coordinate  system  of  the  tracking  platform.  If  the  tracking  platform  is  not  the  detecting 
platform,  the  calculations  are  made  by  subroutine  COVLNK,  which  is  discussed  in  section 
2.3.4.  The  measurement  covariance  is  used  by  KALMAN  to  determine  the  statistical  dis¬ 
tance  from  the  detection  to  the  target. 

The  subroutine  is  presented  with  the  standard  deviations  of  the  range,  azimuth,  and 
elevation.  It  is  assumed  that  there  is  no  cross-correlation  between  the  three  measurements, 
hence,  the  covariance  matrix  as  represented  by  the  standard  deviations  is  diagonalized.  Since 
the  measurements  are  made  in  the  deck-plane  coordinates,  it  is  OOVOWN’s  task  to  trans¬ 
form  this  matrix  to  the  stabilized  coordinate  system  of  the  tracking  platform.  Because  the 
deck-plane  coordinate  system  is  continually  in  rotational  motion  wiA  respect  to  the  stabi¬ 
lized  coordinate  system,  this  procedure  must  be  carried  out  each  time  a  statistical  distance  is 
requested  by  CORRAS. 
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The  process  can  be  represented  mathematically  as  follows:  the  position  vector  in  the 
deck-plane  coordinates  can  be  expressed  as  a  truncated  Taylor’s  series 


X 

X 

dxIdR 

bx/br] 

bxjba 

y 

= 

y 

+ 

by/bR 

bylbi) 

by/ba 

z 

~z 

. 

bzIbR 

bz/br] 

bz/ba 

(2.3.1) 


where 


(dxIdRfdxIdt),  etc.) 


(N„Nrj,Na) 


(R,  V,  “) 


is  the  mean  or  true  position  of  the  target  in  the  platform’s 
deck-plane  coordinate  system 

is  the  target  position  vector  in  the  platform’s  deck-plane 
coordinate  system,  based  on  measurements  made  at  the 
platform 

are  the  partial  derivatives  of  the  components  of  the  position 
vector  with  respect  to  changes  in  the  measurements  made  at 
the  platform 

represent  noise  in  the  measurements  made  by  the  platform’s 
radar 

represent  the  range,  elevation,  and  azimuth  measurements 
made  by  the  platform. 


If  vector  matrix  notation  is  used,  Eq.  (2.3.1)  may  be  rewritten  as 


X  =  X  +  AN.  (2.3.2) 

The  deck  plane  coordinates  can  be  transformed  from  the  stabilized  coordinates  by  the 
H(I,J)  and  P(I,J)  matrices.  The  H  matrix  accounts  for  the  platform’s  heading  and  the  P 
matrix  accounts  for  the  platform’s  pitch  and  roll.  This  can  be  expressed  as 

ii’hx  =  H'P(X  +  A‘N)  (2.3.3) 

or 

H-P(X-X)  =  H'P’A'N.  (2.3.4) 

The  left  side  of  Eq.  (2.3.4)  represents  the  measurement  error  in  the  stabilized  coordinate 
system  and  it  is  the  covariance  of  this  quantity  that  is  required;  i.e.. 


cov(Af)=  E{H'P’A'N-N'^'A'^’’P'^'H'^) 
or  ^ 

=  H-P-A'N-N'^'A'^'P'^'H^. 


(2.3.5) 
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This  is  represented  by  the  ^WM{I,J)  matrix  in  the  listing;  the  product  H’  P  •  A  is  given  by 
the  {AJS{I,J)  matrix,  and  N  *  ^  is  die  diagonalized  covariance  represented  by  the  standard 
deviations  in  range,  azimuth,  and  elevation  measurements. 

The  covariance  matrix,  the  time  at  which  the  detection  was  made,  the  track  with  V7hich 
is  has  been  correlated,  and  die  measured  stabilized  coordinates  of  the  detection  are  pre¬ 
sented  to  the  KALMAN  subroutine  which  determines  the  statistical  distance.  This  completes 
the  process  and  control  is  returned  to  CORRAS.  A  flowchart  of  the  process  and  a  list  of 
Fortran  variables  are  in  Fig.  2.13  and  Table  2.13,  respectively. 


Fig.  2.13  —  Subroutine  COVOWN 


GRINDLAY 


ZM1  »  XYZMS  (IDETNO,  1,  IRAD,  ISHIP) 
ZM2  =  XYZMSdDETNO.  2.  tRAD,  (SHIP) 
ZM3  =  XYZMS  nOETNO,  3.  IRAD,  ISHIP} 


Set  up  state 
vector  and  pre 
dieted  covariance 
tor  KALMAN 


Set  up  predic 

ves 

ted  state  vector 
lor  KALMAN 

RETURN 


Fig.  2.13  (Concluded)  —  Subroutine  (X)VOWN 
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Table  2.13  -  Variables  in  OOVOWN 


Fortran 

Variable 

Description 

IRAD 

Number  of  radar  making  detection 

ISHIP 

Number  of  platform  making  detection 

IDETNO 

Number  of  detection  under  consideration 

NT 

Number  of  track  that  correlates  with  IDETNO 

SD 

Statistical  distance 

ISEC 

Sector  in  which  detection  was  made 

MT 

Multiple  platform  track  number  corresponding  to  NT 

TRKST(I,J) 

File  that  contains  MPT  niunber  of  dummy  track  I 
from  platform  J 

PTFST(I,J) 

File  that  contains  platform  number  of  the  platform 
that  is  tracking  dummy  track  I  from  platform  J 

SHD(I) 

Current  heading  of  ship  I 

H(I,J) 

Array  that  accounts  for  platform’s  heading  in 
coordinate  transformation 

P(I,J) 

Array  that  accounts  for  platform’s  roU  and  pitch  in 
coordinate  transformation  < 

ROLL(J),  PITCH(J) 

Current  roll  and  pitch  of  platform  J 

ELND(IT,ISHIP,IRAD)  ] 
AZND(IT,ISHIP,IRAD)  \ 
RNND(IT,ISHIP,IRAD) ) 

Noisy  deck-plane  measurements  of  target  IT  as  made 
by  IRAD  on  platform  ISHIP. 

A2(M) 

Array  of  partial  derivatives  of  Ith  component  of 
position  vector  with  respect  to  Jth  component  of 
measurement 

CX)VM(M) 

Measurement  covariance  matrix 

COVMS(N,I,J^,L) 

Measurement  covariance  matrix  associated  with 
detection  N,  radar  K,  and  platform  L 

XYZMS(I,J,K,L) 

Measurement  position  vector  of  detection  I,  radar  K, 
platform  L 

KFLAG 

Indicator  that  tells  KALMAN  that  call  is  for  statistical 
distance  calculation  (KFLAG  =  2)  or  updating 
(KGLAG  =  1) 

TMS(I,J,K) 

Time  at  which  detection  I  was  made  by  radar  J  on 
platform  K 

TIMLNK(V) 

Time  at  which  track  I  was  last  updated  by  platform  J 

XSMO(M,K) 

Smoothed  position  vector  of  track  J  as  determined  by 
platform  K 

ORINDLAY 


2.3.4  Subroutine  COVLNK 

Subroutine  COVLNK  is  called  by  subroutine  COVOWN  and  sutoroutine  UPDATE. 
When  the  tracking  platform  is  not  the  detecting  platform,  COVLNK  is  called  to  produce  the 
measurement  covariance  matrix  in  the  tracking  platform’s  stabilized  coordinate  system.  The 
measurement  covariance  is  used  by  KALMAN  to  determine  the  statistical  distance  from  the 
detection  to  the  target. 

As  with  COVOWN  the  problem  is  to  transform  the  measurement  covariance  matrix  to 
the  stabilized  coordinate  system  of  the  tracking  platform.  The  process  is  further  compli¬ 
cated  by  uncertainties  in  the  relative  location  of  the  two  platforms.  Mathematically  it  can  be 
represented  as  follows:  the  position  vector  with  respect  to  the  supposed  location  of  the 
tracking  platform’s  origin  is  given  by 

X^  +  T  [Sj  +  AXj  ]  +  U  (2.3.6) 


where  T  and  U  are  rotational  and  translational  matrices,  respectively. is  &e  location 
of  the  target  in  the  detecting  platform’s  stabilized  coordinate  system  and  Aa  ^  represents 
the  inexact  location  of  the  detecting  platform.  The  position  vector  of  the  ta:%et  in  the 
tracking  platform’s  stabilized  coordinate  system  is  given  by 

S  =  X2-^2  (2.3.7) 


=  T  [Sj  +  ]  +  U  -  /^2  (2.3.8) 


=  T  +  AY  +  AVj  ]  +  U  -  ^2  (2.3.9) 

where  H  and  P  are  defined  as  in  COVOWN  and  is  the  position  vector  of  the  target  in  the 
detecting  platform’s  deck-plane  system.  The  stabilized  position  vector  (S2)  can  also  be 
expressed  as  a  truncated  Taylor’s  series 
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*2 

*2 

. 

.bt^lbiix^  bs^lb^y^  bn^lbda^ 

^2 

'2 

+ 

3*j/3Axj  3«2/3Ayj  . 

.  bs^lbiix^  bs^lbAy^  bs^lbbz^ 

“2 

“2 

38j/3A*^  35g/3Ay^  . 

.  bs^lbhx^  bs^lbAy^  bs^lbAz^ 

N 


Ay, 


N 


A*, 


N 


N 


N 


N 


A*. 


(2.3.10) 


or 

Sg  =  Sj  +  A‘N  (2.3.11) 


and 

■A  -  ~ 

Sg  -  Sg  =  ^  ^  (2.3.12) 

where  the  elements  of  are  found  from  differentiating  Eq.  (2.3.9).  The  left  side  of  Eq. 
(2.3.12)  represents  the  error  in  the  position  of  the  target  in  ^e  tracking  platform’s 
stabilized  coordinate  system.  Errors  are  induced  by  inaccurate  measurements  from  the 
detecting  platform  and  the  inexact  locations  of  both  platforms.  It  is  the  covariance  of  this 
quantity  that  is  needed  for  determining  the  statistical  distance  and  updating,  i.e.. 
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or 


co\iM)  =  E(A’N‘^A^) 


(2.3.13) 


=  A'N'N^'A^ 


(2.3.14) 


which  is  represented  by  the  COVM(/,J)  matrix  in  the  program  listing  and  NN^  is  the 
diagonaliz^  covariance  matrix  represented  by  the  standard  deviations  of  measurements 
and  platform  locations.  The  covariance  matrix  is  returned  to  COVOWN  or  to  UPDATE  for 
the  KALMAN  subroutine.  The  Fortran  and  variables  not  used  in  COVOWN  are  listed  in 
Table  2.14. 


Table  2.14  —  Variables  Not  Used  in  COVOWN 


Fortran 

Variable 

Description 

KS 

Detecting  platform 

ID 

Detection  number 

IR 

Radar  number  of  radar  making  detection 

JSHIP 

Tracking  platform 

SLAT(I),  SLOG(l) 

Current  latitude  and  longitude  of  platform  I 

T(I,J) 

Transformation  matrix  for  transforming  from  one 
platform’s  stabilized  coordinate  system  to  another 

A(M) 

Array  of  partial  derivatives  as  defined  in  £q.  (2.3.10) 

N(I) 

Standard  deviations  of  noise  in  measurement  and 
platform  positions 

2.3.5  Subroutine  KALMAN 

Subroutine  KALMAN  is  called  by  subroutines  COVOWN  to  provide  statistical  distance 
information  and  by  subroutine  UPDATE  to  update  the  estimate  of  the  state  vector  of  a 
given  track.  The  nnootbing  and  estimation  process  is  performed  by  a  Kalman  filtering 
algorithm  similar  to  the  2D  algorithm  described  in  Ref.  3.  The  state  equation  in  the  tracking 
platform’s  stabilized  coordinate  system  is  given  by 


X(t  +  l)-d(f)X(t)  +  r(t)A(t) 


(2.3.16) 


40 


NRL  REPORT  8358 


where 


X{t)  = 


X(0 

1  T  0  0  0  0 

X(t) 

0  1  0  0  0  0 

y(t) 

,  m  = 

0  0  1  T  0  0 

y(0 

0  0  0  1  0  0 

z(t) 

0  0  0  0  1  r 

z(t) 

0  0  0  0  0  1 

r(t)  = 


T 

0 

0 

0 

0 


0 

0 

T 

0 

0 


0 

0 

0 

0 

T 


andi4(0  = 


a,(t) 


Oyit) 

0,(0 


(2.3.16) 


with  being  the  state  vector  at  time  t  consisting  of  position  and  velocity  components 
x(t),  x(t),  y(t),  y  (0>  2(0>  and  z(t),  t  1  being  the  next  observation  time,  T  being  the  time 
between  measurements,  and  Oyit),  and  a^it)  being  random  accelerations  whose 
covariance  matrix  is  Q(t).  The  observation  equation  is 

Y(t)  =  M(t)X{t)  +  N(t), 


where 


1 

X 

_ 1 

“i  0  0  0  0  0  ■ 

Y{t)  = 

,  M(t)  = 

0  0  1  0  0  0 

andlV(0  •= 

Vy(t) 

0  0  0  0  1  0 

. 

with  Y(t)  being  the  measurement  at  time  t  consisting  of  positions  x„  (t),  2^ (f )>  ond  (0; 
and  N(t)  being  zero  mean  noise  whose  covariance  matrix  is  R(t),  provided  by  COVOWN  or 
COVLNK. 
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The  problem  is  solved  recursively  by  first  assuming  jhat  the  problem  is  solved  at  time 
(t  -  1).  SpecificaUy  it  is  assumed  that  the  best  estimate  X(t-  1  U  -  1)  at  time  (t  -  1)  and 
its  error  covariwce  matrix  P(t  -  lit-  1)  are  known,  where  the  circumflex  signifies  an 
estimate  and  X  (t  I  s)  signifies  that  X(t)  is  being  estimated  with  observations  up  to  F(s).  The 


six  steps  involved  in  the  recursive  algorithm  are  as  follows: 

Step  1.  Calculate  one-step  prediction 

i(t|t  - 1)  =  ^(f  -  l)X(t  -  lit  - 1)  (2.3.18) 

Step  2.  Calculate  the  covariance  matrix  for  one-step  prediction, 

/•(tit  -  1)  =  «(t  -  l)P(t  -  lit  -  l)?(t  -  1)  +  r(t  -  l)Q(t  -  DHt  -  1)  (2.3.19) 

Step  3.  Calculate  the  prediction  observation 

y(t|t  -  1)  =  Af(t)X(t|t  -  1)  (2.3.20) 

Step  4.  Calculate  the  filter  gain 

A(t)  =  P(t|t  -  l)jGf(t)  lM{t)P(t\t  -  l)M(t)  +  it(f)]  -1  (2.3.21) 

Step  5.  Calculate  a  new  smoothed  estimate 

iCtlt)  =  X(t\t  -  1)  +  A(t)  iy(t)  -  Y{t\t  -  1)]  (2.3.22) 

Step  6.  Calculate  a  new  covariance  matrix 

P(t|t)  =  [/  -  A(t)M(f)]P(t|t  -  1).  (2.3.23) 


In  summary,  with  an  estimate  X(t-  1 1 1  -  1)  and  its  covariance  matrix  P(t  -  1 1 1  -  1),  after 
a  new  observation  y(t)  is^received  and  tire  six  qiumtities  in  the  recursive  algorithm  are  cal¬ 
culated,  a  new  estimate  X  (f  1 0  and  its  covariance  matrix  P(t  1 1)  are  obtained. 

For  each  track,  the  first  two  passes  through  KALMAN  are  used  to  initialize  the  filter. 
On  the  first  pass  the  smoothed  covariance  is  approximated  by  setting  the  appropriate  ele¬ 
ments  equal  to  the  measurement  covariance  matrix.  On  the  second  pass  the  definition  of  the 
smoothed  covariance  matrix,  the  current  measurement  covariance,  and  previous  smoothed 
covariance  and  the  time  step  are  used  to  determine  the  elements  of  the  new  smoothed 
covariance  matrix.  When  KALMAN  is  called  for  statistical  distance  before  the  first  two 
passes  are  complete,  the  statistical  distance  is  arbitrarily  assigned  a  value  of  10.  The  statisti¬ 
cal  distance  as  calci^ted  by  the  model  is  fire  squared  Mahalanobis  distance  [2]  from  the 
smoothed  track  position  to  the  predicted  track  position  plus  the  Mahalanobis  distance  from 
the  smoothed  position  to  the  measured  position.  The  Midialanobis  distance  differs  firom  the 
Euclidian  distance  in  that  a  covariance  matrix  kernel  is  used  instead  of  the  identity  matrix. 

The  Fortran  variables  equivalent  to  the  algebraic  variables  used  in  Eqs.  (2.3.18) 
through  (2.3.23)  are  listed  in  Table  2.15. 
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Table  2.15  —  Variables  in  Recursive  Algorithm  of  Eqs.  (2.3.18)  to  (2.3.23) 


Fortran 

Variable 

Description 

XP(I) 

Predicted  state  vector  X  (t\t-  1) 

ZM(I) 

Measurement  vector  Y(t) 

PS(I,J) 

Smoothed  covariance  matrix  P(r  U) 

COVM(I,J) 

Measurement  covariance  matrix  R{t) 

TDEL 

Time  between  measurements  T 

H(I,J) 

Matrix  M(t)  from  observation  Eq.  (2.3.17) 

WT(I,J) 

Filter  gain  At 

PHKW) 

State  transition  matrix  0(t  -  1) 

PP(U) 

Predicted  covariance  matrix  P(f  1 1  -  1) 

COVS(I,J) 

Covariance  of  random  accelerations  Q(t) 

G(J,K) 

State  transition  matrix  r(f  -  1) 

XS(I) 

Smoothed  state  vector  X  (t  1 1) 

2.3.6  Subroutine  SORT 

Subroutine  SORT  is  called  by  the  MULSIM  executive  routine.  Its  primary  purpose  is  to 
sort  the  detections  associated  with  the  tracks  in  a  given  sector  into  three  distinct  categories: 
those  associated  with  tracks  from  participating  platforms,  those  associated  with  tracks  from 
the  detecting  platform’s  file,  and  tiliose  associate  with  tracks  that  another  platform  is 
responsible  for  updating. 

SORT  is  presented  with  a  designated  platform,  sector,  and  radar.  The  detections 
associated  with  each  track  in  the  sector  file  are  processed  according  to  which  category  the 
track  falls  into.  If  the  track  is  a  participating  platform  no  further  processing  is  required  since 
platform  updating  is  not  dependent  on  radar  detections;  however,  it  is  proposed  in  the 
future  to  use  the  detections  of  platfonns  to  develop  a  bias  removal  scheme.  If  the  track  is 
assigned  to  another  platform,  the  detecting  platform’s  roll,  pitch,  and  heading  are  placed  in 
files  for  transmission  over  the  link,  and  a  random  delay  is  added  to  the  detection  time  to 
produce  the  time  at  which  the  detection  information  will  be  sent  over  the  link.  This 
information  is  next  used  by  the  contact  selector  subroutine  (TIMCON)  to  select  contacts 
for  transmission  over  the  link.  Last,  if  the  track  is  assigned  to  the  detecting  platform,  the 
linked  TESTO  file  is  loaded  with  information  for  accessing  the  detection  files.  TESTO  con¬ 
tains  the  identification  number  of  all  detections  that  have  recently  been  associated  with 
the  track  under  consideration. 

When  all  tracks  in  the  sector  track  file  have  been  considered,  control  is  returned  to  the 
executive  routine.  A  flowchart  of  the  process  and  a  list  of  Fortran  variables  are  found  in 
Fig.  2.14  and  Table  2.16  respectively. 


43 


ORINDLAY 


S«lMt  uack  from 
MCtor  track  file 


NT  -  DUMSX  (ISEC.  ISHIP) 

- 


NT  -  0 


Any  track! 
left  m  file? 


It  (rack  a 

penrcipating 

platform’ 


LOC  -  OETSX  INTI 
lOETNO  *  ISTOR  ILOXI 


lOETNO  *  0 


KS  -  PTFST  INT.  ISHIPI 
MT  -  TRKST  (NT.  ISHIPI 


MPFLAG^ 
(MT.  KSl  «  0 


■V  f>0 

Proposed  bias 

? 

removal  scNtme  '  • 

ROILNK  (lOETNO.  (SHIP)  «  ROLL  (ISHIPI 
PITLNK  (lOETNO.  ISHIPI  «  PITCH  (iSHiP) 
SHOLNK  (lOETNO.  ISHIPI  -  SHO  (ISHIPI 


CALL  DETLOC 


TESTO(LOC.  11  =  lOETNO 
TESTOILOC.ZI  *  ISHIP 
T6STO(LOC.3l  =  IRAD 
FILID  (LOCI  -  FILFX  (NT.  iSHIPl 
FILFX  INT.  ISHIPI  =  LOC 


TRAN  IIOETNO.  IRAQ.  ISHIPI  -  (RANO  (1l  '1.  9i 
*  1  «  TMS  (lOETNO.  (RAC.  ISHIPl 
SOIST  «  SOiLOCi 


NRL  REPORT  8368 


Table  2.16  -  Variables  in  SORT 


Fortran 

Variable 

Description 

ISEC,  ISHIP,  IRAO 

Sector,  platform,  and  radar  under  consideration 

DUMSX(ISEC,ISTOP) 

Array  that  contains  the  track  number  of  first  track  in 
platform  ISHIP’s  sector  track  file 

DETSX(NT) 

Pointer  fiiat  provides  location  of  detection  information 
on  detection  that  has  been  associated  with  track  NT 

ISTOR(LOC) 

File  containing  the  number  of  the  detection  associated 
with  track  NT.  LOG  is  provided  by  DETSX. 

PTFST(NT,ISHIP) 

Number  of  the  platform  responsible  for  updating  track 

NT  from  ISHIP’s  dummy  sector  file 

TRKST(NT,ISHIP) 

Number  of  MPT  track  that  corresponds  to  track  NT  from 
ISHIP’s  dummy  sector  file 

ROLL(I) 

PITCH(I),  SHD(I) 

Current  roll,  pitch,  and  heading  of  platform  I 

TMS(I,J,K) 

Time  of  detection  for  detection  I  in  platform  K’s  Jth 
sector 

TESTO(LOC,I) 

Linked  file  containing  numbers  of  the  detections  associ¬ 
ated  with  track  NT.  File  also  contains  respective  platform 
and  radar  numbers 

1  =  1;  detection  number 
=  2;  platform  number 
=  3;  radar  number 

FILFX(NTJ) 

Pointer  for  accessing  TESTO  file.  Gives  location  of  last 
detection  number,  etc.,  to  be  associated  will)  NT  from 
platform  I’s  dummy  to  be  sector  file 

FILID(LOC) 

Linking  device  that  links  locations  of  all  of  the  detections 
associated  with  track  NT 

2.3.7  Subroutine  TIMCON 

Subroutine  TIMCON  is  called  by  subroutine  SORT.  Its  primary  function  is  to  act  as  a 
rudimentary  contact  selector;  i.e.,  it  decides  which  of  the  many  detections  should  be 
selected  for  transmission  over  the  communications  link.  This  is  accomplished  by  dividing 
time  into  1-s  intervals  and  defining  five  intervals  as  a  time  slot.  When  a  target  is  detected,  a 
flag  (ISLOT)  that  identifies  the  associated  track,  the  platform,  and  the  time  interval  is 
changed  from  zero  to  one.  When  additional  detections  are  considered,  the  time  interval  flags 
are  examined.  If  a  previous  associated  detection  has  been  transmitted  in  the  current  time 
interval  or  in  the  four  previous  time  intervals  (which  totals  one  time  slot),  then  the  detec¬ 
tion  is  rejected.  For  those  detections  selected  for  transmission,  the  LNKSTO  file  is  loaded 
with  the  detection  number,  the  detecting  platform’s  number,  the  detecting  radar’s  number. 
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the  MPT  number  of  the  associated  track,  and  the  updating  platform’s  number.  The 
LNKSTO  file  is  used  in  the  updating  process  to  identify  tiie  detections  that  are  candidates 
for  updating  a  specified  track. 

This  firstcome-first-served  type  of  selector  is  obviously  not  the  optimum  contact 
selector.  Other  selectors  are  being  considered  and  will  be  installed  in  the  future.  A  flowchart 
of  the  process  and  a  list  of  Fortran  variables  are  found  in  Fig.  2.16  and  Table  2.17 
respectively. 


Pig.  2.16  —  Subroutine  TIMCON 
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Table  2.17  -  Variables  in  TIMCON 


Fortran 

Variable 

Description 

IDETNO 

Number  of  tiie  detection  under  consideration 

MT 

Number  of  the  MPT  track  associated  with  IDETNO 

KS 

Platform  responsible  for  updating  track  MT 

IS,1R 

Platform  and  radar  making  detection  IDETNO 

ISEC 

Sector  containing  track  MT 

SDIST 

Statistical  distance  between  MT  and  IDETNO 

FULLNK 

Counter  that  keeps  track  of  the  number  of  detections  in 
LNKSTO  file 

TMS(ID,IR,IS) 

Detection  time  of  detection  ID,  firom  radar  IR  on 
platfonn  IS 

TMRK(ISEC,IR,IS) 

Sector-crossing  time  at  sector  ISEC 

rriME 

Detection  time  truncated  to  an  integer 

MOD60 

ITIME  modulo  60  s 

ISLOT(MT,KS,I) 

Time  slot  I  for  track  MT  firom  platform  KS 

LNKFSX 

Pointing  device  for  accessing  LNKSTO  file 

LNKID(LOC) 

Linking  device  that  links  locations  in  LNKSTO 

LNKSTO(LOC,I) 

Linked  file  containing  identification  information  on 
associated  detections  that  are  being  sent  over  the  link 

1=1;  detection  number 
=  2;  detecting  platform’s  number 
=  3;  detecting  radar’s  number 
=  4;  MPT  number  of  associated  track 
=  5;  updating  platform’s  number 

2.3.8  Subroutine  LNKDET 

Subroutine  LNKDET  is  called  by  the  MULSIM  executive  routine.  Its  primary  purpose 
is  to  chronologically  order  the  detections  associated  with  the  tracks  in  the  sector  track  file 
designated  by  the  sector/platform  in  the  calling  sequence.  This  includes  detections  made  by 
the  updating  platform  and  those  provided  by  other  platforms  via  the  communications  link. 

LNKDET  first  interrogates  the  LNKSTO  file,  which  contains  all  of  riie  detections 
transmitted  over  the  link  in  the  last  30  s.  Those  detections  associated  with  tracks  from  the 
updating  platform  (regardless  of  which  sector  the  track  may  be  in)  are  selected  and  stored 
in  the  TESTO  linked  file,  which,  for  each  track,  contains  the  detection  numbers,  the  detect¬ 
ing  platforms,  and  the  detecting  radars  corresponding  to  those  detections  associated  with 
the  track  that  have  not  yet  been  used  to  update  the  track.  After  storing  the  detections  in  the 
TESTO  files,  the  locations  that  housed  the  detections  in  the  LNKSTO  file  are  vacated. 
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The  next  step  in  the  process  is  to  consider  each  track  in  the  sector  designated  in  the 
calling  sequence.  The  detections  associated  with  each  track  are  called  up  from  the  TESTO 
file  and  their  locations  in  TESTO  are  placed  in  the  ILOC  sequential  file  according  to  their 
times  of  detection.  The  location  of  the  detection  with  the  oldest  detection  time  is  placed  at 
the  top  of  the  file,  i.e.,  IIX>C(1).  The  locations  in  the  TESTO  file  are  vacated  in  tiie 
UPDATE  subroutine  only  after  the  detections  are  used  in  the  updating  process. 

The  ordered  sequential  file  (ILOC)  is  presented  to  UPDATE  for  the  updating  proce¬ 
dure.  This  process  is  repeated  until  all  tracks  in  the  designated  sector  have  been  considered, 
whereupon  control  is  returned  to  the  MULSIM  executive  routine.  Table  2.18  defines 
variables  used  in  LNKDET;  Fig.  2.16  shows  the  flowchart  for  the  subroutine. 


Table  2.18  -  Variables  in  LNKDET 


Fortran 

Variable 

Description 

ISHBP,  ISEC,  IRAD 

Platform,  sector,  and  radar  to  be  considered  for  updating 
process 

DUMSX(ISEC,ISHIP) 

Number  of  the  last  track  to  be  placed  in  platform 

ISHIP’s  dummy  track  file 

LNKFSX 

Location  of  last  associated  detection  to  be  placed  in 

LNKSTO  file 

LNKSTO 

See  Table  2.17. 

DUMST(KS,MS,IS) 

Number  of  the  track  platform  IS’s  sector  track  files  that 
corresponds  to  track  MS  from  platform  KS’s  MPT  files 

TRAN(ID,IR,IS) 

Time  at  which  platform  IS  transmitted  data  on  detection 

ID 

TMRK(ISEC,IR,IS) 

Sector-crossing  time  for  sector  ISEC,  radar  IR  on 
platform  IS 

TMS(ID,IR,IS 

Tune  at  which  platform  IS  detected  detection  ID  with 
radar  IR 

TLAST(NT,IS) 

Time  at  which  track  NT  from  platform  IS’s  dummy  track 
file  was  last  updated 

TESTO(LOCC,I) 

See  Table  2.16. 

FILFX(NT,ISHIP) 

See  Table  2.16. 

FILID(LOC) 

See  Table  2.16. 

PTFST(NT,IS) 

Number  of  the  platform  responsible  for  updating  track 

NT  from  platform  IS’s  dummy  track  file 
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Table  2.18  (Concluded)  —  Variables  in  LNKDET 


Fortran 

Variable 

Description 

TRKST(NTJS) 

Number  of  the  MPT  corresponding  to  dummy  track  NT 

MPFLAG(MT4CS) 

Indicator  —  MPFLAG  =  0  indicates  that  track  MT  is  not  a 
participating  platform,  otherwise  MPFLAG  is  assigned  a 
value  equal  to  the  target  number  corresponding  to  the 
platform 

DUMID(NT,IS) 

Number  of  the  track  that  was  placed  in  platform  IS’s 
dummy  track  file  prior  to  track  NT 

2.3.9  Subroutine  UPDATE 

Subroutine  UPDATE  is  called  by  subroutine  LNKDET  to  carry  out  the  updating 
process  for  NT,  a  designated  track.  There  are  two  separate  paths  through  UPDATE.  One 
path  is  followed  when  NT  is  a  participating  platform  with  position  update  coming  from 
NAVSTAR  or  JTIDS,  and  the  other  is  followed  when  a  tai^et  is  being  tracked  firom  radar 
measurements. 

For  those  tracks  that  are  of  participating  platforms,  an  attempt  is  made  to  emulate  the 
operation  of  a  system  that  includes  NAVSTAR  or  JTIDS.  Updates  to  participating  plat¬ 
forms  are  made  every  2  s  and,  to  allow  for  time  lags  in  the  system,  to  within  1  s  of  current 
time.  Once  it  has  been  determined  that  an  update  has  not  b^n  made  within  the  last  2  s,  a 
call  is  made  to  SHPGEN  and  SCOORD  to  determine  the  platform’s  position  at  current  time 
less  1  s.  Because  of  the  relative  accuracy  of  JTIDS  and  NAVSTAR,  the  true  stabilized  coor¬ 
dinates  are  used  as  measurements,  and  the  measurement  covariance  matrix  is  arbitrarily  set 
with  diagonal  elements  of  100  m^  and  off-diagonal  elements  of  0.1  m^.  This  information  is 
presented  to  KALMAN  for  the  platform  updating. 

For  those  tracks  that  are  not  of  participating  platforms,  the  first  step  in  the  process  is 
to  examine  the  list  of  associated  detections  in  the  TESTO  file.  To  allow  for  delays  in  proc¬ 
essing,  the  subroutine  considers  only  those  detections  that  were  made  before  TIMUP. 
TIMUP  is  equal  to  current  time  less  some  appropriate  delay  (TIMLAG).  The  detections  are 
selected  chronologically  from  the  TESTO  ffle  (oldest  first).  The  corresponding  noisy 
measurements  are  called  up  from  the  XYZMS  file  and  if  the  detecting  platform  is  not  the 
updating  platform,  the  measurements  are  transformed  to  the  updating  platform’s  stabilized 
coordinate  system  by  the  TRANSF  subroutine.  This  transformation  is  also  carried  out  for 
the  true  position  coordinates,  and  the  measurement  covariance  matrix  is  transformed  by  the 
CXIVLNK  subroutine.  The  measurements,  together  with  the  time  from  the  last  update,  are 
presented  to  KALMAN,  which  determines  the  new  smoothed  position  for  the  track.  After 
the  last  detection  is  considered,  the  smoothed  state  vector,  the  smoothed  covariance  matrix, 
and  the  predicted  covariance  matrix  are  stored  in  arrays  for  the  next  call  to  update. 
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Fig.  2.16  (Concluded)  —  Subroutine  LNKDET 
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This  completes  the  updating  process  for  track  NT,  and  coniiol  is  returned  to  tiie 
LNKDET  subroutine.  A  flowchart  of  the  process  and  a  list  of  Fortran  variables  are  found  in 
Fig.  2.17  and  Table  2.19,  respectively. 


Fig.  2.17  —  Subroutis  ^  UPDATE 
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CALL  TRANSF 


DO  45  I  =  1,3 
DO  45  L  =  1,3 

COVM  II,  LI  -  COVMS  IIS,  I,  L,  LR,  LSI 


•ymT — j< 

XP 121  XSMO 12,  MT,  ISHIPI 
XPI3I  Y 

XP  141  =  XSMO  (4,  MT,  ISHIPI 
XP 151  =  Z 

XP  161  XSMO  16,  MT,  ISHIPI 


Fig.  2.17  (Continued)  —  Subroutine  UPDATE 
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Pig.  2.17  (Continued)  —  Subroutine  UPDATE 
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Table  2.19  —  Variables  in  UPDATE 


Fortran 

Variable 

Description 

NT 

Track  number  of  updating  candidate. 

ISEC,  IRAD,  ISHIP 

Sector  containing  NT,  the  radar  that  detected  NT,  and 
the  detecting  platform 

K 

Indicator  K  »  999  indicates  that  NT  is  a  participating 
platform;  if  K  f  999,  then  K  equals  the  number  of  detec¬ 
tions  that  have  been  associated  with  NT. 

TRKST(I.J) 

File  that  contains  the  MPT  track  number  of  dummy  track 

I  from  platform  J’s  dummy  track  file 

TMRK(I,J,K) 

Time  at  which  radar  J  on  platform  K  crosses  sector  I 

TIMLAG 

Time  lag  to  allow  for  processing/transmission  delays 

TIMUP 

Current  time  less  TIMLAG.  Track  NT  will  be  updated  to 
TIMUP  but  not  beyond. 

XS(I) 

Smoothed  state  vector 

PS(I,L) 

Smoothed  covariance  matrix 

TESTO(ILOC(J),K) 

See  Table  2.16. 

IDTA(IDJR,IS) 

File  containing  target  niunber  of  detection  ID 
from  radar  IR  on  platform  IS 

XY2MS(ID,J,IR,IS) 

Measurement  coordinates  of  detection  ID  in  platform  IS’s 
stabilized  coordinate  system 

TLAST(NT,ISHIP) 

Time  of  last  update  for  track  NT 

XYZTRU(ID,J,IR,IS) 

True  position  coordinates  of  detection  ID  in  platform 

IS’s  stabilized  coordinate  system 

XSM9(I^,IS) 

Smoothed  state  vector  of  track  MT  from  platform  IS’s 

MPT  file 

TMS(ID,IR,IS) 

Time  at  which  detection  ID  was  detected  by  radar  IR  on 
platform  IS 

MPFLAG 

See  Table  2.18. 

IFIRST(MT,IS) 

Counter  that  records  the  number  of  calls  to  UPDATE  for 
track  MT 

RG(M)^Z(M) 

Range,  azimuth,  and  elevation  of  target  I  with  respect  to 

EL(M) 

platform  J  in  platform  J’s  stabilized  coordinate  system 

COVM(M) 

Measurement  covariance  matrix 

COVSMO(I,J^,IS) 

Error  covariance  for  track  MT 

PRECX)V(I,J>IT,IS) 

Predicted  covariance  for  track  MT 
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3.0  SUMMARY  AND  RESULTS 

A  computer  simulation  has  been  developed  that  will  serve  as  a  foundation  for  future 
software  development  and  at  the  same  time  allow  the  user  to  demonstrate  the  advantages 
and  limitations  inherent  in  a  multiple  platform  sensor  integration  system. 

Some  preliminary  results  have  been  generated  through  the  use  of  a  simplified  scenario 
used  in  program  development  (see  Fig.  3.1).  In  the  scenario  three  ships  are  moving  due  east 
near  the  equator.  They  are  separated  by  1°  in  latitude  (60  n  jni.)  or  longitude,  and  a  single 
target  is  iq>proaching  from  the  east  at  1000  m/s.  Each  ship  has  a  single  radar.  The  measure¬ 
ment  accuracies  of  all  three  radars  are  modeled  by  nBMimmg  standard  deviations  of  100  m 
on  the  range  measurement,  0.5°  in  the  azimuth  measurement,  and  1°  in  the  elevation 
measurement.  The  radar  on  ship  1  has  a  4-s  scan  rate  and  the  radars  on  ships  2  and  3  are 
scanning  at  a  6-8  rate. 


1° 


SOn.mi. 


0° 


SHIP  2 


SHIP  3 


V 


SHIP  1 

•  SOn.mi, 


1,000m/s  ^ 

— 


Fig.  3.1  —  Simplified  i^nario  (initial  positions) 


An  example  of  a  single  ship’s  tracking  capability  over  a  100-s  time  interval  is  shown  in 
Fig.  3.2.  In  this  case  the  measured  and  smoothed  y  coordinate  of  the  target  as  determined 
by  ship  1  is  presented.  Since  the  y  measurement  as  determined  by  ship  1  is  essentially  an 
angular  measurement,  it  does  not  have  the  accuracy  associated  with  a  range  measurement; 
consequently  the  measurement  tends  to  be  quite  noisy. 

When  measurements  from  ship  2  are  combined  with  measurements  from  ship  1  to  pro¬ 
duce  the  smoothed  y  position,  there  is  agnificant  improvement  in  the  system's  tracking 
accuracy,  as  shown  in  Fig.  3.3. 
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The  improvement  is  less  pronounced  when  ship  3  makes  its  contribution.  However,  it 
should  be  noted  that  initially  the  y  coordinate  as  determined  by  ship  3  is  essentially  a  range 
measurement  that  is  very  accurate.  This  is  apparent  in  Fig.  3.4  as  evidenced  by  the  large 
number  of  detections  from  ship  3,  which  initially  lie  close  to  the  true  pontion.  These 
accurate  detections,  together  with  the  inoeased  data  rate,  enable  the  3-ship  system  to 
produce  a  highly  accurate  track  in  a  relatively  short  time.  The  accuracy  of  ship  3’s 
y  measurement  decreases  with  time,  whereas  that  of  ship  2’s  improves  as  the  target 
i^proaches  ship  1. 

Results  have  also  been  generated  with  a  rudimentary  contact  selector  that  rejects  track 
measurements  when  a  previous  measurement  has  been  made  within  some  designated  time 
slot.  Time  slots  of  3  and  5  s  have  been  used  with  a  3-ship  system  to  generate  the  results 
shown  in  Figs.  3.5  and  3.6.  The  results  are  encouraging.  The  3-s  time  slot,  with  a  25% 
reduction  in  the  number  of  detections,  shows  little  degradation  of  track  quality,  and  the  5-s 
time  slot  with  a  43%  reduction  gives  tmk  quality  comparable  to  that  of  a  2-diip  system 
with  no  contact  selector. 
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Fig.  8.3  —Two-chip  cyitrai;  tnck  of  target’!  y  coordinate 
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Fig.  3,4  —  Thiw-diip  ayiteiii;  no  contact  aelector.  T^ack  of  target’!  y  coordinate 
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Fig.  3.5  —  Tbree«hip  lyiteni  with  time  dot;  track  of  target’*  y  coordinate 
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Fig.  3.6  —  Three-chip  ayitein  with  6-*  time  dot;  track  of  target’s  y  coordinate 
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S9URCE  listing 
STATEMENT 


Appendix 

PROGRAM  LISTINGS 


PROGRAM  MAIN 

C(*“M6N/PLBT/IPLT(10n0),X)(t  (1000),  VVVIlOflO)#  NP.YTNt  moo  ).IT  IS  (1000) 
CaMM9N/MBDUL8yISL0T(JO,5,6O),IKEY(l),IMOD20,IMnD60 
C"MM«N/RA0NEX/SECTIM(J,S),TIMNEX(S,S),Ne>(SEC(3,S),NR(5).*>S,NT 
CaMM9N/NEM/AZ(20.20),RG(2C,20),EL(20,20) 

CBMMON/OATEUP/NUMTRG.NLMSHP 

C0KM0N/SECT9R/KS£C(6a,S) 

CALL  RI8T8P 

CALL  PLOTSdPLT, 1000, 0.55) 

NP  ■  1 
PRINT  300 

300  F"RHAT(/,15X,'TIkE',TX,iI.  0 . • , 1 IX , ' * ' , 1 2* , ' Y • , 1 2X ,  •  Z  '  ,  1 1 » ,  •  VY < , 

1 IIX, 'VY  ' , IIX,  'VZ'  ,TX,  'P  ATPSRMt ) 

TIME  ■  0. 
knit  ■  1 
call  INITAL 
NUMSHP  «  NS 
NUMTRG  X  NT 
NTS  *  NTtNS 
10  continue 

call  TRK6EN(TImE,NT) 

CALL  SHP6EN(TIME,NS) 

call  mBT18n(TIme,nS) 

08  20  JxlfNS 

call  SCI’8RD(NT,NS,J) 

call  TC88R0(NT,J) 

CALL  STABI (NT.NS, J) 

20  CONTINUE 

CALL  LOAD(KNIT,TIme) 

IP(KNIT,Ea.2)  GO  TO  30 
KNIT  X  2 

time  X  1 
G8  TO  10 
30  CONTINUE 

call  nexrao(IR,ISHIP,I8EC,TImE) 

IE(K5EC(ISEC,ISMIP).Ne.'')  GO  TO  32 
IF(KSEC(ISEC-1,IShIP).nE.O)  go  T8  32 
IFCKSEC(ISEC*1,ISmiP).sF.O)  G8  Te  32 
IF(KSEC(ISEC-2,ISMIPi.nE.O)  G8  to  32 
IF(KSEC(ISfC*2,TSMTP).NF,n)  G8  TO  32 
GO  TO  38 
32  CONTINUE 
DO  33  Ixt,6X 
KSFC(I,ISMIP)  X  0 
35  continue 

call  TSkren{Tihe,nt) 
call  SmpgEN(TImf,ns) 
call  MOTION(TIMf ,ns) 
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MAIN 

CSN 


oo«a 

OOAA 

ooso 

0«!1 

0«Si 

00S3 

00S4 

ooss 

oost 

DOST 

oosa 

OOS9 

0060 

0061 

0062 

0063 

0060 

0063 

0066 

0067 

006a 

0069 

0070 

0071 

0072 

0073 

0070 

0075 

0076 

0077 

0070 

0079 

ooao 

ooai 

0062 

0083 

ooao 


CALL  SCOORO(NT«NS.ISM1P) 

CALL  TC80BO{NT,I8M1M) 

CALL  DETFIL<IR.18MIP,ISEC,NT,NS) 
CALL  STABt(NT,N8,ISMIP) 
call  NOISV(IR,ISHtP,ISEC) 
IFdlME.LE.  1.11  60  TO  JO 
Sa  CONTINUE 

laEC  »  ISEC-l 
IF(iaEC.EQ.O)  ISECs6a 
call  PREDIcriSEC.lR.tSMlP) 

I3CC  a  lOEC*! 
tF(ISEC.EQ.O)  ISECaOO 
CALL  CORRAS(ISHtP.ISEC.IR) 

CALL  SORTdSEC.ISNIP.lR) 

ITIM  a  TIME 

Mfl020  a  m0O(ITIM,IM0O2O) 
IF(Ma020.NE.0)  60  TO  60 
MOO60  a  KBOflTlM, 1X01)601 
IDEM  a  (Me060y20)  *  1 
IF(lKfY(10EM).NF.o)  GO  TO  60 
K  I  M0D60A  20 
J  ■  H0060*t 
DO  55  laJ.K 
no  1311,5 
00  55  HTaU20 
lSL0T(MT,t8,n  a  " 

55  continue 

IKEY(IOEM)  a  1 
IDEM  a  IDEM+l 
IFdOEH.EO.O)  ir-EMil 
I«EY(10EM)  a  0 
60  CONTINUE 

call  LNK0ET(ISMIP,IS£C,IR) 

IF(TIHE.LT.150.)  GO  TO  JO 

NP  a  nP«1 

RETURN 

END 


65 


GRINDLAY 


CSN 


0001  SUBB8UTINE  IN!T»L 

00a2  C'!'**'<8N/L9CNEW/L*ST8,FULSTfl,LISTe(2S*)  #K'f  KSTB.KJ 

0003  C«MM8N/IJPn*TE/lL''C(?0)»TIML*6,TeSTStS12,S),TL*ST(256,5) 

oooa  CBt'H9N/TAG/ITAG(20,5,S,6«) 

OOOS  CBMMBN/CBVI/  St6»ZD{20,2).SIC£LO(20,2).«HBO(20,2) 

0006  CB*<MBN/STATIC/M(B>«N2(3) 

OOOT  CB>‘*‘9N/K*L<l/IEI<IST(20.5)»OI'*l»'>I>'2,ni“3 

0008  Cfl‘'><BN/HpT/0RflPt‘(5),HPTN9(5).FUUL'*r5).L18T^‘t5,20», 

1NFXTH(5),LA8TH(5)  , 

0004  rO(<N9H/l.9COET/LASOET,FLLOET,LISnETr256).NEXOET 

0010  CPR*‘9N/LflA0/X8AV(3,20,3)»*iI'<F{3,5),PVFLf  3,5),P4CPIFf3,3) 

0011  CBP’'BN/DUM/OR9PO(5)»OUF^9(5)#FlJLLD(5).LI8TDt5•512)»^EXTO(5)* 

1LA8T0(5)  .  , 

0012  C9»*MflN/CBHA8/0ETSX(256)»lST9P(256),0ETI0f5l2) 

0013  C9PM0N/SBRT/FtLFX(2SO.S)»FltI0(5l2)  . 

0014  C9MMOH/RAONEX/SECTIP(3,5).TIP»)£Xt3,5)»AEX8EC(3,5),APfSJ.^S,NT 

00  IS  CBP“9N/PAP3/TtLATf20)»ttLflG(20),TlHT (2ni,TTV(2o),TIHC(20) 

0016  C4«MflN/PAP4/SILAT{20).SILflG(20),9lHT(2U),81Vt20)*SIHnf2O) 

OOlT  C"HP''N/PxR8/  RMA6(2n).P*'AG(2B), “90(20. "BPlFO 

OOlR  C9HM0N/PAH7/  RBLL(20).P1TCM{20),RPMASE(20),PPHA8E(P0) 

0014  CBPP9N/L9CL*<»</LASLNK,FI,LLNK,L1SLNK(20),“EXLNX 

0020  CBMH9N/KAL1/  PHr(2Q,20).G(20,2O,H(20,20) 

0021  CBPH''R/“B0ULByISLflT{20,S,6O,  IKEVtS) .  IHBn20»  I“B06  0 

0022  CBP“9N/RANnUP/IRAN(20.S) 

0023  nt“£NSI«N  TV£L(256),SV£L(5) 

JJIs  INTEGER*^FILIO,FlLFX,FULL''.OR9P‘'.FULLP.CRePD.OIPl  >DI“P»Dl*'3,FULL“x 

0026  INTEGER  OETSX.OETIO.FULSTB 

0027  CALL  9ETVR(17) 


0028 

KJ  4  0 

0024 

PADa,0174S3242S2 

0039 

OIPl  ■  3 

0031 

DIH2  ■  6 

0932 

D1P3  ■  0 

0033 

TIPLAG  4  2 

OQja 

UASOCT  4  256 

0038 

NEXOET  4  1 

0036 

PNGOlPd.n  4 

lOOflP 

0037 

RN60lN(2in  4 

10000 

0938 

N(l)  4  IS. 

0034 

N(2)  4  15. 

9040 

N(3I  4  20. 

0041 

N(4)  4  100. 

0042 

N(S)  4  1. 

0043 

N(6)  4  .5 

0040 

N(7)  4  15. 

0045 

N(8]  4  15. 

0046 

N{41  4  20. 

0047 

N2(t)  4  too. 
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INIT4L 

CSN 


0046 

0449 

0050 
0051 
0052 
0053 
0054 
0055 
OOSb 
0057 
0058 
0054 
0060 
0061 
0062 
0063 
0064 
0065 
0066 
0067 
0068 
0069 
0070 
0071 
0072 
0073 
0074 
0075 
0076 
0077 
99  U 
0079 
0990 
0081 
0082 
0083 
0084 
0085 
0086 
0087 
0088 
0089 
000.0 
0091 
0092 
0093 
0094 
0095 
0096 
0097 


N2(2)  ■  1. 

N2(3)  «  .5 
N(5)  •  N(5)*R4P 
N(6)  ■  N(6]*RAD 
N2(2)  «  N2(2)*R*0 
N2(3)  ■  K2(3)*RA0 
SIGAZDC2il)  a  .5 
SIGELn(2,n  a  1.0 
RH00(2>1)  a  100. 
SI6AZ0(l«na.5 
SIGElOd.nal.O 
RHOOClt  t)«tOU. 

00  10  Zal,25S 
LISOETd)  a  !♦! 
OETSXC)  a  0 

to  CONTINUE 

00  20  lal,256 
00  20  Jal.S 
FILFX(I.J)  a  0 
20  CONTINUE 

00  30  lal,512 
FILIOdJ  a  0 
30  CONTINUE 

00  200  lal,20 
DO  200  Jal.S 
IRANd.J)  a  J«5*(t>l) 
200  CONTINUE 
NS  a  1 
NS  a  2 
NS  a  3 

SlGAZDIJal)  a  .5 
SIGELD(3«n  a  1.0 
RN00(3«I}  a  100. 
AZINTd.3)  a  270. 
PltELd<3)  a  90. 
S1LAT(3)  a  1, 
61L9GC3I  9  1. 

SIHT(3)  a  «. 

S1H0(3J  a  90. 

SVEI(3]  a  to. 
RNGDIN(3,1)  •  10000. 
NR(3)  a  1 
NT  4  1  - 
NRCll  a  1 
NRCZ)  a  1 
AZINTd,2)  a  90. 
AZlNTd.l)  a  0 
RVELd»l)  a  90. 
BVEUU.Z]  a  60. 

DO  40  Jal,NS 


ORINDLAY 


INITAL 

CSN 


OIMB 

0049 

0100 

OlOl 

0102 

OIOS 

0104 

0105 

0104 

0107 

0108 

0109 

0110 

out 

0112 

Oils 

0114 

Oils 

0116 

OUT 

0118 

0114 

0120 

0121 

0122 

0I2S 

0124 

0125 

0126 

0127 

0128 

0129 

OISO 

0111 

0132 

OISS 

0130 

0135 

0136 

0137 

0118 

0139 

0140 

0141 

0142 

0143 

0144 

0145 

0146 


K  4.  NR(J) 

08  40  lal.K 

SCCTIH(l.J)  s  5.625/RVEL(I«J) 

40  CONTINUE 
SlLATllliO. 

3IL0G(l)a0. 

aiHT(l)40» 

8IH0(l)a90. 

TILATll)  a  0.1 
TILATdJaO. 

TXLOGdlal. 

TIHTd)a2A00. 

TIHOlDfOQ. 

81L*T(2)al. 

SlL8G(2)aO. 

8IHT(2)aO. 

atND(2)a40. 

TVELd)a300. 

t^ELdJaOOO. 

TVELd)  a  tOOO. 

SVELdlalO. 

SVEL(2)alA. 

ERa637e388. 

PRa63549t1  . 

JJ1_  a  EP.»ER 
Q2aPR*PR 
DO  SO  lit. NT 
Sla8IN(TILATd)*RAD) 
COaCOaiTlLATdlaRAO) 
RHeTaSQRT(Q«*02/(Ql*St*Sd02*CO*CO)) 
RMOTfRHOTTTIHTd) 
TlV(I)a(TVEU(I)/RHOTi/S*D 
50  CONTINUE 
00  60  tal.NS 
Sl9SIN(SILATd)*RA0) 
C0aC0S<8IUATd)*RAp) 
PH9SaSQRT(Ol*Q2/(Gl*SI«SlTO2*CO*C0)) 
RHOSaRHOa  +  aiHTd) 
8IV(Ila(5VEL(H/RHe8)/RA0 
60  CONTINUE 
C  POTION  INPUT8 
RPAGdlaO. 

PNAGdJaO. 

PORdlaO. 

HOPdlaO. 

RPHASEdlao. 

PPPASEdJao. 

RPAG(2}aO. 

PHAG{2JaO. 

WOR(2)aO. 
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XN1T*L 


CSN 

0147 

wap(2)40. 

0148 

RPH6SE(2>>0. 

0149 

PPHASC(2)40. 

C  MPTFIL  *Nt)  DUHFTU  IMITIiLlZATtnii 

OISO 

08  70  laltS 

0151 

L*8TH(I)  ISO 

0152 

ORBPPd)  tl 

015S 

FULlxtl)  ■  19 

0154 

LASTPd)  1  20 

0155 

NCXTMd)  41 

0158 

08  70  J4t,19 

0157 

LISTMd.J)  4 

0158 

70 

CONTINUE 

0159 

00  80  141,5 

0180 

OROPOdl  4  t 

0161 

LASTDd)  4  512 

0162 

FULLOd)  4  Sit 

0165 

NEXTOd)  4  1 

0164 

00  80  J41.S11 

0165 

LISTOd.J)  4  J«t 

0166 

80 

CONTINUE 

0167 

FULLNK  4  19 

0168 

LA8LNK  4  20 

0169 

NEXUNK  4  1 

0170 

DO  90  lfl.l9 

0171 

LISUNKd)  4  I«t 

0172 

90 

CONTINUE 

0171 

00  no  I41,D1M2 

0174 

00  no  j4i,DiPt 

0175 

6d,J)  4  0. 

QUO 

4  0. 

0177 

110 

CONTINUE 

0178 

Mil. 11  •  1. 

0179 

N(2#3)  4  1. 

0180 

H(3.5}  4  1. 

0181 

IN0O2O  4  20 

0162 

1NIIQ60  ■  60 

0183 

00  120  l4i,20 

0184 

00  120  Jans 

0185 

00  120  K4t,60 

0186 

ISLOTCI.J.K)  4  0 

0187 

120 

CONTINUE 

0188 

DO  Ufl  ITai.2o 

0189 

0"  150  IR41,3 

0190 

DO  130  1041,5 

0191 

00  150  ISECan64 

0192 

IT6GdT,lR,IS,iaEC)  4  0 

0195 

llO 

CONTINUE 

0.19.4 

UEUTO  a  1 

0195 

FUL8T0  4  255 

0196 

UST0  a  256 

0197 

DO  140  141,255 

0198 

LISTOdl  8l«l 

0199 

140 

CONTINUE 

0200 

RETURN 

0201 

END 

69 


QRINDLAY 


onoi 

0002 

QOOJ 

ooea 

ooos 

OOOb 

COOT 


D0D6 

0909 

com 

coll 

0012 

0011 

oom 

0015 

oom 

0017 

0018 

0019 

0020 

0021 

0022 

0023 

0020 

0025 

0020 

0027 

0028 

0029 

0030 

0031 

0033 

0033 

0030 

0035 

0030 

0037 

0038 

0039 

0000 

0001 

0003 

0003 

0000 

00o5 


SUORQUTtKE  LOtOlKNIT.TIHC) 

CO»IM8«/OOL2/  OS<2O,2ai.PPC2O«2O),C0VS(20f2O)«COVM(2O.20),XP(20) 
COPHON/LOOO/XSOV(3,20,3)«021N7(3>5l.PVEL(3.5).RNGDlP(5t3) 
CANH8N/R*0MEK/SFCtIH{3.5),TIPNCX<3tS).KEX8FC(3,5}<NPl5)mS>MT 
C0»*M0M/l»PT/oROPH(5)»MPTNei5),FU\.l.P(51,LtSTP(5.3O)f 
1NEXTH{5),L*8T»*(5) 

CPHHON/UPD*T£/ILOC(20)/73P|.*6»tE8TC(512,3),TL*ST(258,5) 

C9MMaN/LTNK/LNKF8X,LNKSTP120,5),DUM8T(5.20,5)tTRKaTr20,20)«PrF8Tf2 

l0.20).UHFio(2o).TiMtNK(20,5)fRPLLNKt20,5).P3Tt«F<20,5>,apetNP130,5 

2l.x8M0(20,2O,S).CflVSMp(iP,i0,2o.5)>PREC»V(l»>10,20,S)/PPFLO6(2O«5) 

Cnt'*‘9N/0UPSEC/00PSX(60,5),DUP10t512.5) 

C(»iHflN/DUMyOR0P0r5)>PU»N0(5)tFliLl.O(5)fl.38lD(5t512)|OEXTn(5)i 

\L*ST0(5) 

C«pMOM/*ieP/F2(?0.20).R6<20«20),  EL  (20(30) 

CflMHON/LCOE/NUHTFR 

integer  OU*<*X,OUNTP,FMtlO#ORePD#OUMNB,PTF8T (TRUST, ORRPP.OUPST 

NTS  •  NT(NS 

00  too  Jal.MTS 

DO  too  Kil.NS 

lF(t<NIT.E0.2)  69  TO  00 

If ((J-NTj.eO.K)  G9  TO  100 

XS*V(i,J,K)  «  R6(J,KmsrN(«3(J(K))  *  CB8(EL(J(K)) 

XSLV(2,J,K)  a  RG(J,K)«CB$(*Z(J,K))  «  CBS(EL(J(K)) 

XSaV(3(J,K)  a  RG(J,M)«StN(EL(J,K)) 

GO  TO  100 

00  continue 

if((J-nT),eo.x)  CO  TO  mo 
J8CC  R  F3(J(K)»tO(lB%9m 
ISEC  a  JSEC  *  1 
ORnPO(K)  a  1 

call  OUPFIL(X) 

CALL  OUMNEW(OUHNB(K),ISEC(X) 

IFm.CO.l)  60  TO  OS 
tr<(JmNTt,ne,t  (OP.R.NC.a)  so  70  80 
05  CONTINUE 
OROPN(K)  a  I 
CALL  MPTFILIf) 

TRKST(CUMN0(K)(K>  a  MPTNOdO 
PrfST<0UNA8(K),PJ  a  tr 
DUM8T(K(PPTN0(K)(K)  a  OUPNB(K> 

XSPBdil'PTNBlKJ.X)  a  RG (^(K ) aSIN ( A7 ( J ,K ) )  *  CB5(El(J,K)) 
X8P0(3,PPTN8(RJ,ai  a  RC(J,K)«CGB(AZ(J(N))  •  CB8(ELI3(K)) 
x8N«(5,NPTNfl()<),K)  a  RG(J(K>*SIN(EL(J(X)) 

X8N0(2(NPTNB(K),K)  a  (X8MB( I (HPTNB(K) (K).X8AV ( 1 , J(II))/T1PE 
78P9(0,NPTN0(K),I«)  a  (XSPn(3(PPTN9 (K)  (XmXS AV (2, J(K) ) /TINE 
*SPaCp(HPTaia(a».HA)  •  <»»P8(4,PPTH«(K),«>««8AV(3,JrP))/TIPE 
TLAST(DUPNfl(N),K)  a  1. 
ri«LNP<NPTNff(X),K)  a  t 
C  INITIALIZE  COVAPIANCE  FOR  FILTER 
IRC  a| 
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L«AD 

CSic 


0046 

0047 

0046 

0049 

0050 

OOSt 

0052 

0055 

COSO 

0055 

0050 

0057 

0056 

0059 

flOoO 

OOol 

0062 

0005 

0064 

0065 

0066 

0067 

0068 

0069 

0070 

0071 

0072 

0071 

0074 

0075 

0076 

0077 

0078 

0079 

0080 

008( 

0082 

0083 

0084 

0085 

0086 


IDT  ■  0 

CALL  8TAB2(J,K,IR0) 

NUMTAR  ■  J 

call  C0v06N(lRo,l(.lOT«0UI4Ne(K),6O>tSEC) 
C0VSH8(l,t,MPTNe(K)«K)  a  C0VR(l,|) 
COVS40(3,1,MPTNa(6)«K)  a  C8VM(2,2) 
C«V8M0(5,5,hPTNB{K),k)  a  C6yPtS,3) 

CnvSMOI I ,3,mPTn8(4),k)  a  C8VP(I(2) 

CnvSHBd,  t  |HPTN8(K),|< )  a  CBVM(),2) 

C0V3MB ( t f 5>HPTNB(K)f N)  a  C8VP(i«S) 

C«V8“B(5» 1 ,MPTNe(K),K)  a  CBVP(1,3) 
CBVSmB(3i5«hPTNB(4),k)  a  CBVM(2,3) 

CnvSMn(S,3,MPTNB(K),N)  s  CBVM(2,3) 
HPFLAG(NPTN8(KJ,i<)  a  0 
IF(J.GT,KT)  HPFLA6(MPTK8(K),K)  a  J 
C  MPPLAG  NE  ZERO  INOIRICATES  PARTICIRATING  PLATFORM 
Gfl  TB  100 

5o  CBnTINUE 

TlASTlCypMfitKl^M)  a  1. 

IF(I<,6T,2  .AND,  (J'MTl.re.l)  GB  TO  55 
TRK8T(0lJMMn(K),Ml  a  hPTNBd) 

PTF8T(DIIMM0(K),K)  a  1 
OUmST(1,MPTM0(1),k)  a  CUMMOtK) 

GO  TO  100 
55  COLTIMUE 

TRkST(CUFNO(K),k)  a  MPTM0(2) 

PTF8T(CUHMe(K),K)  a  ? 
nUMST(2>MPTN0d)«4 )  a  CUMMBfK) 

100  CONTINUE 

DO  60  Ja|,NS 
F  a  SR(4) 

DO  60  Ial,K 

AZRAO  a  aZInT(I,J)  *  TIM£*rvfL(I>J) 

NEXSEC{t,J)  a  A7RA0/5.62S 
RSeC  a  NEXSeCd.J)  ♦  l. 

A7T0  a  (RSEe*5.625)  •  AZRAO 
TIMNEX(I,J)  a  AlTn/RvEL(!,J)4TtME 
NFXSEC(I,J)  a  nexSFC(I,J)  ♦  i 
60  •'FXSECd.J)  a  NCXSECd,J).6- 

RETURN 

FNO 
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CSN 


SUBROUTIKC  NEXR«D(IR,I3.ISEC,TtMt) 

Ct********************************************************************** 

C  SURRBUTJNE  NEXRAO  DETERMINES  NHIpH  RaRAR  will  NEXT  MAKE  A  SECTSR  CRS8S« 
C  ING.  ITS  8UTPUT  I0ENTIEIE8  THE  RADAR, THE  SHIP,  AND  THE.  SECTBR.  THE  TlMf 
C  OE  the  SECTSR  CR9S8ING  IS  ALSS  GIVEN. 

C**AAA**AAA*AAAAAA*A*AAA********************«****«**«**********A*******. 

C9mm9N/0ETECT/XV2h8(20,S,S,5),TM8 (20, S,5),C8VM8 (20,3,3,1,5), 
tLSTBlN(64,100,l,S),XS(20),TMRK(64,3,5),TRATG(20),LNK8IN(2n,3,5) 
C8MH8N/RADNEX/SECTIM(1,5),TIHNEX(1,5),NEX8EC(1,S),NR(5),NS,NT 
10  C8NTINUE 
Kll 
Lai 

SAVTIH  ■  100000. 

08  20  Jal,NS 
JNR  a  NR(J) 

DO  20  iBl.JNR 

C  CHECK  TO  SEE  IF  TIME  OE  NEXT  SECTOR  CROSSING  FOR  THIS  RARaR  IS  GREATER 
C  than  SavTIm. 

0011  IF(TIMN£X(1,J).GT.8AVT1H)  G8  TO  20 

0012  K  a  1 

0013  L  a  J 

0014  SAVTIM  a  TImneX(I.J) 

OOlS  20  CONTINUE 

0016  ISEC  a  NEXSEC(K,L) 

0017  IR  a  K 

OOia  IS  a  L 

0014  NEXSEC(K,L)  a  NEXSEC(K,L)»1 

0020  IF(NEXSeC(K.L).LT.6S)  C8  TO  10 

0021  NEXSEC(K,L)  a  1 

0022  30  CONTINUE 

0023  TMRK(1SEC,K,L)  a  TIMNEx(K,L) 

0024  TIMNCX(K,L)  a  TImnCXIK.L)  ♦  SECTIM(K,L) 

042S  IF(TMRK(1SEC,K,L).LT.TIME)  GO  TB  10 

0020  TIHE  a  84VTIM 

0027  RETURN 

0020  END 


CSN 


OOOl  subroutine  MnTION(TIHE,NS) 

0002  CBNMON/PART/  ROLL (20) ,PI TCH(20) ,RPHASE  (2n )  ,PPHASE  (20 ) 

0003  COMMON/PARS/  RMAG  (20)  ,PMAG  (20)  ,  WOR  (20  )  ,  WP  (20  ) 

0004  RADa. 01705324252 

0005  00  100  Ia|,NS 

0006  ARGaCOS((MaR(I)aTIHE«RPHASE(I))aRAD) 

0007  R0LL(I)aRMA6(I)*ARG 

OOOB  AR6aC0S((h0P(I)aTlMEtPPHASE(I))*PAD) 

0004  PITCH(I)aPMAC(I)*ARG 

0010  100  CONTINUE 

0011  RETURN 

0012  END 


0001 


0002 

0003 

0004 

0005 

0006 

0007 

0008 

0004 

0010 
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ON 

0001 

OURROUTINE  SH0GEN(TImE«NS> 

0001 

C0NN0N/PAf>2/SL4T(2O),SteG(2O),SHT(20).OHD(20) 

0003 

CeNNaN/P4R4/SIt.AT(2Q),STLSG(20),SlHT(2v),SIV(20),SIHn(20) 

0000 

R*0«, 01743329252 

0003 

DO  500  III, NS 

000* 

CaSIVCllATIMEtPAO 

OOOT 

XPaO. 

0000 

yPaSINlC) 

0009 

ZPaCOSCC) 

0010 

XlaYP*SIN(SIH0(I)*R*0) 

0011 

VlaVP*C08(SIHO(I)*R*Ol 

0012 

ZlaZP 

0013 

CL«aCOS(SIL4T(l)*R*0) 

0014 

SL*aSlN(SIL*T(n*RiO) 

0015 

CLesC0S(aiL0G(l)*R40) 

001* 

SLeaSlN(SlL9G(l)*RA0) 

0017 

XGaCI.0<tXl>SL4*SLe*VUCL4*SL4»Zl 

0010 

YGaCLA*Ylf3LA*Zl 

0014 

Z68«SLO*Xt«SLA*CLO*Yl*CLA*CLO*Z1 

0020 

R0aX6*XGfZG*ZG 

0021 

RtaSORT(RS) 

0022 

1F(R1>. 000001)  310.340,340 

0023 

310 

IF(VG)  320,330,330 

0024 

320 

SLAT(t)a.90. 

0023 

GO  TO  350 

002* 

330 

SLATdlaOO. 

0027 

60  TO  330 

0020 

340 

SLAT(I)aATAN2(YG,Rl)/RA0 

0029 

350 

AZGaABSCZG) 

0030 

IPXXZG*. 000001)  360,390,390 

0031 

360 

IF(X6)  370,300,380 

0032 

370 

$196(1)8.90. 

0033 

GO  T9  400 

0034 

300 

8196(1)890. 

0033 

GO  TO  400 

001* 

390 

SL0G(I)aATAN2(X6.Z6)/RAC 

0037 

400 

CONTINUE 

0030 

8HT(I)a8lNT(I) 

0039 

XPal, 

0040 

YPaO. 

0041 

ZPaO. 

0042 

AINTaAB8(SIND(I}).ieo. 

0043 

IF(AINT. ,000091)  402,403,403 

0044 

402 

AlNTaieo. 

0043 

403 

AINTaSIHOd) 

004* 

XlaXP*C9S(AXNT*RAD) 

0047 

Yt8*XP*SIN(AINT*RA0) 

*0.40 

UaZP 

0049 

CLA8C08(SlLATd)*RA0) 
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GRINDLAY 


SHP6EN 


C8N 

OOSO 

8L*Ji8tN(31L4T(X)*O40) 

0051 

CLOaCOOCOILOGC 11**46) 

0052 

3L0a3tN(0tL«6(n*R4O) 

0055 

X624CL0*Xl>3L4*8(.«*Yt*CL4*SL0*21 

0050 

VG24CL4*YU0L4*2I 

0055 

2624>OLO«XfOL4*CLO*Vl*Ct.4*CLO*Zl 

005* 

CL0aCaS(8L06(l)*R4O) 

005T 

8L04*IN(0L0G(I)*R4D) 

0050 

XGlaCLO 

005* 

2Gl4-0La 

00*0 

ARG4XG14X62*ZG1*Z62 

00*1 

ir(4RG«l.)  420<4t0«4l0 

00*2 

410 

4R0al. 

00*3 

420 

IR(4RG*I,]  430<430,440 

00*0 

430 

4RGa«l. 

00*5 

440 

0HD(I)a4CSS(4RG)>RA0 

00** 

irtAiNT)  a5b«46o«a60 

00*T 

450 

OHO(na>SHD(I) 

00*0 

4*0 

CONTINUE 

00*0 

IPOHOdl)  47e,400«4ao 

0070 

470 

SH0(I}a3*0.*3H0(I) 

0071 

400 

CONTINUE 

0072 

500 

CONTINUE 

0075 

return 

0074 

END 

74 


NRL  REPORT  8S68 


CSN 


0001 

SUeOOUTINE  TRKGEN(TtHE,MT) 

0002 

COMHON/P*R1/TL*T(20J,Tl8G(20),THT 

0003 

C«H*<0N/PtR3/TI1.6T(20)>7lL06(20),7: 

0004 

R60«. 01745329232 

ooos 

00  200  III, NT 

0000 

CaTIV(n*TlHE*R40 

ooor 

XPaO. 

0008 

YPaSIN(C) 

0009 

2PaCeS(C) 

goto 

XlaVP*StN(TIH0(!)*R60) 

0011 

Y|aVP*CeS(TIH0(l)*R6D) 

0012 

21aZP 

0013 

CL*aCOS(TlL*T(n*R*D) 

0014 

8LAaSIN(TIL4T(t)*R60) 

0013 

CLOaCBSlTlLOOtllaRAO) 

0016 

OLOaSlNCTILOGdlaRAO) 

ootr 

XGaCl.e*Xl.SI.A*aL0*Yt*CCA*8l.a*Zl 

0018 

YGaCLAAYlYSLAAZl 

0014 

ZGa«SLO*Xl.SLA*CLO*Y|aCl A*CLn*7l 

0020 

R0aX6*XGAZG*ZG 

0021 

RtaSaRT(RO) 

0022 

IF(R1>. 000001}  10<a0,40 

0023 

10 

IP(YG)  20,30,30 

0024 

20 

TLATOa-OO. 

0023 

GO  TO  30 

0026 

30 

TLATCDaOO. 

0027 

GO  TO  50 

0028 

40 

TI,AT(I)aATAN2(YC,Rl}/RAD 

0029 

30 

AZQaABStZG) 

0030 

lP(AZ6«.o.oooan  60,9e,90 

0031 

60 

XP(XG)  70,80,80 

0032 

70 

TL06(I)a«90, 

0033 

60  TO  100 

0034 

80 

TLOGTDaOO. 

0033 

GO  TO  100 

0036 

90 

TL06(I)aArAN2(XG,ZG)/PAO 

0037 

too 

CONTINUE 

0030 

TNTdlaTIMTd) 

0039 

XPal. 

0040 

YRaO. 

0041 

ZPaO. 

0042 

AINT«ABS(TIHD(1)]>180. 

0043 

IF(AINT«. 000001}  102,103,103 

0044 

102 

AINTalOO. 

0043 

103 

AINTaTIMO(I) 

0046 

Xla*PAC08(AlNT»RAB) 

0047 

Yla«XP*SIN(AINT«RAD) 

0048 

ZlaZP 

0049 

CLAaC09(TIUAT(n*RA0) 
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QOSO 

0051 

0052 

0053 

0050 

0055 

0050 

005T 

0058 

0059 

0060 

0061 

0062 

0061 

0060 

0065 

0066 

0067 

0068 

0069 

0070 

0071 

0072 

aavi 


SU*SIN(TtL6T(I)*ft«0) 

CLeaC0S(7IL66(n*R«0) 

SU0a81N(7ILe6(I)*R*O) 

XG3«CI.O**1*SU*«SLO*71*CL*»SLB»71 

yG2aCLA*Yl«aL6*71 

2G2a»8Lfl*Xl«SL**CtO*Y1 ♦CLA»CL0*Zl 

CUaC0S(TL0G(I)«RA0) 

SLeaSI**(TLBG(n*RAD) 

XGlaCLO 

ZGloSLO 

ARCaXGiaX62YZGl*ZG2 
1F(6RG»1.1  120<UO,110 
llOARGal. 

120  IF(ARG«1.>  llO.tlA.iao 
130  ARGa«l. 

too  THO(I)aAC4S(AR6)/RAO 
IF(AINT)  150.160.160 
150  TM0(l)a"7H0(I) 

160  CONTJNUE 

IF(TH0(1))  170. 180.180 
170  TMD(l)a360,+TH0(l) 

180  continue 
200  CONTINUE 
return 
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0001 

0002 

OOOS 

0000 

0008 

0006 

0007 

0008 

0004 

0010 

0011 

0012 

0013 

0010 

0018 

0016 

0017 

0018 

0014 

0020 

0021 

0022 

0023 

0024 

0028 

0026 

0027 

0028 

0024 

0030 

0031 

0032 

0033 

0034 

0038 

0036 

0037 

0030 

0034 

0040 

0041 

0042 

0043 

0004 

0048 

0046 

0047 

0048 

0044 


SUBOOUTIME  SC04R0(MT,NS,ISHIP) 
C9HHeN/SECT0R/K8EC(64,8) 

COHH0N/P*P2/8L*T(20),SLe6(20).SHT(20),SHI5(2O) 

COMHaN/NEM/4Z(20.20),RC(20«2V),EL(2n,20) 

ERI6378388. 

PRa63544ll. 

PI  ■  3.141S42<i84 
TOPI  ■  PI«2. 

QlsERtER 

RA0I.0174S1242S2 
Q2sPR*PR 
J  a  tSHIP 

SLOP  a  8IN(SL06(J)*R*0) 

CLOP  a  C0S(SLeG(J)*R4D) 

SLAP  a  SIM(SLAT(J)*RAD) 

CLAP  a  COS(SLAT(J)*RAD) 

RHOS  a  S0RT(Ql*Q2/(ei*SLAP*SlAP^Q2*CLAP*CLAP)) 
RHOSaRHOS«SHT(J) 

DO  200  Ial,NS 
IF(l.EO.J)  GO  TO  200 
SfaSIN(SLAr(i)*RAn) 

COaCOSCSLATCIltRAO) 

RHOTaSORT (01*02/(0 1 *SI*S I*02*C0*C0 ) ) 
RM0TaRHOT*SHT(I) 

CLAaCOS(SLAT(I)*RAO) 

SLAaSlN(SLAT(t)*RAD) 

CL0aCOS(SLOG(n*RAO) 

SLaaSIN(SLOG(I)*RAO) 

)rBRNOT*CLA*$LO 
YaRHOT*SLA 
ZaRHaT*CLA*CLO 
XP  a  CL8P*X-8L0P*Z 

YP  a  •SLAP*8LflP*X*CL*P«Y»SLAP*CL0P*Z 
ZP  a  CLAP*SLOP*XtSLAP*Y*CLAP*CLOP*Z>RHeS 
OUPaXP*XP*YP*YP 
SOUMaSQRTCOUH] 

AYPaAeS(YP) 

K  a  IfNT 

40  AZ(X«J)  a  ATAN2(XP,YP) 

40  CL(K«J}  a  ArAN2(ZP«S0(JP) 

RG(K,J)  a  80PT(OUH*ZP*ZP) 

XFLAZ(*<«J)]  180.160.160 
ISO  AZ(K,J)  a  T0PI**Z(K.J) 

160  CONTINUE 

ISEC  a  AZ(K,J)*10. 188416 
ISEC  a  ISECfl 

KSECdSEC.lSMIP)  a  KSEC  ( ISEC,  ISHIP )  *  1 
200  CONTINUE 
RETURN 
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0001 

0002 

ooos 

0004 

OOOS 

OOOfc 

0007 

0008 

0009 
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0011 

0012 

0013 

0014 

OOlS 

0010 

0017 

0018 

0019 

0020 

0021 

0022 

0023 

0024 

0023 

0020 

0027 

0028 

0029 

0030 
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0032 

0033 

0034 

0033 
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0037 
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0040 
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0041 

0044 

0043 

0040 

0047 

0048 

0049 


SUBROUTINE  TCe0R0(NT,18HtP) 

CBHHON/SECTOR/KSEC (04»3) 

CeMHON/P4Ri/TL4T(20).TL06(20)«TNT(20)tTHO(20) 

CaHMON/P«R2/8L4T(20),SLOG(20),SHT(20),SHe(20) 

CeMMeN/NEW/4Z(2o.20)«RG(20,28),EL(20.20) 

PI. 9.3.141592054 
TOPI  ■  PI«2. 

ERtoiieseB. 

PR«0354911. 

R4Da. 01745329252 
QlaER*ER 
Q2sP.RaPR 
J  a  ISHIP 

SLOP  a  S1N(SL06(J)*R40) 

CLOP  a  CeS(SLOC(J)*R*D) 

SLAP  a  SIN(SLAT(J1*RA0) 

CLAP  a  CeS(SLAT(J)*RAD) 

RHOS  a  S0RT(Ql*a2/(ai*SLAP*SLAP*Q2*CLAP*CLAP)) 
RHOSaRHOS'fSMTlJ) 

DO  200  lal.NT 
Sla81N(TLAT(I)*RA0) 

C4aC0S(TLAT(I)*RA0) 

RH4TaSGRT(01*Q2/(Qt*SI«Sl«l)2*CO*C0)) 

RHOTaRHOTATHTd) 

CLAaC0S(TLAT(I).R«O) 

8LAa8IN(TLAT(n.R*0) 

CLOacnS(TLOG(I)*RAD) 

SLOa8IN(TL06(l)*RA01 

XBRHaT*CLA*SLf) 

YaRHflT*8LA 
ZaRHOT.CLAaCLO 
XP  a  CLOP*X»8L0P«Z 

YP  a  -SLAPaSLOPtA^CLAPiY^SLAPaCLOP*? 

ZP  a  CLAPaSLOPaXaSLAPaY+CLAPaCLCPaZ-RHOS 

OUHaXPaXPaYPaYP 

SOUNaSORTCOU”! 

40  AZdiJ)  a  ATAN2(XP,YP) 

90  ELd*J]  a  aTAN2(ZP,S0UP) 

100  CONTINUE 

RGdiJ)  a  SQRT(DL*<aZPaZP) 

IF(AZd»J)]  ISO.IOO.IOO 
150  AZdiJ)  a  AZd.Jlt  TOPI 
too  CONTINUE 

I8EC  a  AZd,J)a|0. 185910 
ISEC  a  ISECal 

KSECdSEC,  ISHIP)  a  KSEC (ISEC ,  ISHIP)  ♦  1 
200  CONTINUE 
RETURN 
END 
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SUBROUTINE  DETFIL(tR«IS.ISEC,NT,NS) 

€****•**•******•*•*•**.*•••••.••**•*«.***«*««**««***.**.***•*•**«*.*** 

C  SUBROUTINEDETFIL  assigns  OET.  NO'S  AND  RANGE  BINS  TO  TARGETS  ,  IT  IS 
C  the  FIRST  STEP  IN  CREATING  OETECTIflNS  FROM  ThE  STABLIZED  TARGET 
C  POSITIONS  PROVIDED  BY  THE  STIHUtATTON  PROCESS, 

CAAAtAAAAAAAAAAA**************************,*****. •*•••*•*******••••••• 

.COHMBN/DETECT/XVZH8(20,J,3,5),TMSt80,l,5),COVHS(20,l,J,J,5), 
lLSTBIN(64.100.3,S),XS(20),THRK(6a,}.B:,TRAT6(20),LKKRIN(2(l,3,S) 
CnHMBN/NEH/AZ(24,20),RG(20,20),EL(20,20) 
CaHH0N/DETFIL/IDET(3,5),IDTA(256,3,5) 

CflMM8N/L0AO/XSAV(3,2O,3),AZINTt3,S),RVEL(3,5),RNGOIM(5,3) 
COHMON/TAG/ITAG(20,S,$.6<l) 
integer  TRATG 
ISECHl  ■  ISEC<1 
IF(I8ECH|,EQ.O)  ISECHl  *  «« 

NTS  «  NTaNS 
J  ■  IS 

DO  200  JRN«1,100 
LSTBIN(ISEC,JRN,1R,IS)  aO 
200  CONTINUE 

AZLO  a  S,«.25»(ISEC-n 
AZHI  a  5.625*(ISEC) 

DO  too  lal.NTS 
K  a  I-NT 

C  IF  TARGET  IS  ISHIP  GO  TO  NEXT  TARGET 

0019  IF(K.EQ.J)  GO  TO  100 

C  IS  TARGET  IN  SECTOR? 

0020  AZR  ■  AZCI.JIaST. 295770 

0021  IFCAZ^.LE.AZtO.Ofl.AZR.GT.AZHI)  GO  TO  100 

C  find  range  bin 

0022  JRN  I  RG(I, j)/RNGDIH(IS,IR) 

CCC  check  to  see  if  target  is  hITHIn  mInIhLm  range 
0023  IF(JRN.EQ.O)  GO  TO  100 

C  check  to  see  if  file  is  full 

IF(I0ET(IR,IS),GE.2n)  60  TO  20 
IDET(IR,IS}  a  lOETdR.IS)  ♦  1 
GO  TO  30 
20  CONTINUE 

IDETdR.IS]  a  i 
30.. CONTINUE 

ID  a  IDETdR.IS) 

C  LINK  DETECTIONS  TO  TARGET. 

IOTAdD,IR,IS)  a  I 

CCC  CHECK  TO  SEE  IF  TARGET  HAS  DETECTED  IN  PREVIOUS  SECTOR 
0032  IFdTAGd,:R, IS, ISECHl). EO.l)  GO  TO  199 

0033  ITAGd,IR,IS,ISEC)  a  1 

C  LOAD  DETECTION  NUMBERS  IN  DETECTION  FILE 

0034  TRATGCID)  aO 

0035  LNKBlNCIOdR.IS)  a  LSTBIN ( ISFC ,  JPN,  IR ,  IS ) 

0036  LSTBINdSEC.JRN.IR.IS)  a  ID 

0037  199  CONTINUE 

0036  190  CONTINUE 

0039  DO  150  ITai.Zo 

0040  ITAGCIT.IR, IS, ISECHl)  a  o 

0041  150  CONTINUE 

0042  RETURN 

0043  END 
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0025 

0026 

0027 

0026 

0029 

0030 

0031 


0001 


0002 

0003 

0004 

0005 

0006 

0007 

0000 

0009 

0010 

0011 

0012 

0013 

0014 

0915 

0016 

0017 

OOIB 
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0001 

SUOROUTINE  OnOUNT.NS.tSHlP) 

0002 

C0HHeN/RADIAN/XX(20.20).YV(20,20).SS(20,20) 

0003 

C0HK0N/NEW/A2(2o,20).R6(2O,2fl),EL(2O,20) 

0000 

COMMON/PAR?/  i>ou(sa).PtrcH(eo),RPhtsF.(io},ppHAse<?i>) 

ooos 

COMMPN/P*R2/3LAT(201,8LOCt20),SHT(20),SHn(20) 

0006 

CflHM0N/NEW2/  AZ0(20.20).EUO(20,20),nL0A7(20.2fl) 

0007 

RADa. 01745329252 

0000 

PI  ■  3.141542654 

0000 

TOPI  ■  PI»2. 

0010 

NT3<NT6NS 

0011  ' 

J  ■  ISHIP 

0012 

RR  a  ROLLIJIaRAO 

0013 

PP  a  PITCR(J)*RA0 

0010 

DO  200  tai.NTS 

0015 

lEd-NT.EQ.J)  GO  TO  2flfl 

0016 

AZR  a  AZ(I,J)«(8Hn(J)«RADl 

0017 

ELR  a  EL(I,J) 

oQia 

AAZSaAB3(AZR) 

OOlO 

IP(AAZ3*PI  )  210.240.240 

0020 

210 

IF(AZR)  220.260.260 

0021 

220 

AZR  a  TOPItAZR 

0022 

GO  TO  260 

0023 

240 

IP(AZR)  250.260,260 

0024 

250 

AZRlTOPI'AAZS 

0025 

260 

CONTINUE 

0026 

CaC03(AZR)*3IN(PPl*TAN(ELR)*COS(PP) 

0027 

XaStN(AZR)*C03(RR)AC*SIN(RR) 

0020 

YaC0S(AZRl»C08{PP)-TAN(ELR)ASIN(PP) 

0029 

XXd.J)  a  X 

0030 

YYd.J)  a  Y 

0031 

40 

AZOd.J)  a  ATAN2(X,Y)/RAD 

0032 

50 

lECAZnd.J))  60,65.65 

0033 

60 

AZDd.Jla  360.4  AZOd.J) 

0034 

65 

CONTINUE 

0035 

CaC08(ELR)*C0S(AZR)*SIN(PP)4SlN(ELR)»C0S(PP) 

0036 

S<C*C0S(RR]«C0S(ELR)*SIN{AZR)*SIN(RR) 

0037 

33(1, J1  a  3 

0030 

100 

ELDd.J)  a  AR3IN(S)/RAC 

0034 

110 

CONTINUE 

0040 

ISO 

CONTINUE 

0041 

200 

CONTINUE 

0002 

RETURN 

0043 

END 
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0001 


0002 

0003 

oooa 

0005 

0006 

0007 

oooa 

0000 

0010 

0011 

0012 

0013 

0010 

0015 

0016 

0017 

ooia 

0010 

0020 

0021 

0022 

0023 


SUBROUTINE  N0ISV(IR.I8,tSEC> 

C*******************************«******************************«***** 

C  SUBROUTINE  NOISY  OUTPUTS  THE  NOISY  X,Y,2  STABLIZEP  COORDINATES 
C  OF  EVERY  OECTION  IN  SECTOR  tSEC 

C*A**A****A*A*AAA*****A**A**A***************AA*************A*A***A*** 
CBHHQN/DETECT/XYZHSC20,3»S,5),THS(20,3,5).ceVHS(EOr3,3r3>S), 
lLSTBIN(6a,100,3,5),XS(20),TNRK(6C,3>5)>TRAT6(20),LNKBIN(20,3,5) 
CPNHeN/DETFIL/IOET(],5),IOTA(2S6,3,5) 
COMNQN/NEM/AZ(2(i,20),R6(20«20),EI.(20,20) 
C0MHeN/TRUC/XYZTRU(20«3.3«5) 
c  60  thru  all  range  bins  in  sector 

00  100  JRNil.lOO 
C  FIRST  detection  in  range  BIN 

ID  ■  LSTBIN(ISEC,JRN,1R,IS) 
to  CONTINUE 

C  CHECK  TO  SEE  IF  THERE  ARE  ANY  OTHER  DETECTIONS  IN  RANGE  BINS 
IF(IO.EO.O)  GO  TO  100 

C  GET  TARGET  NUHBER  CORRESPONDING  TO  DETECTION 
IT  ■  IOTA(ID,tR,IS) 

XYZTRU(ID.t.lR,IS)  a  RC (IT, IS ) *SIN ( AZ ( IT, IS) ) aCOS (EL ( IT , IS ) ) 
XYZTRU(I0,2,IR,IS1  a  RC (IT, IS ) «COS ( A7 ( IT, IS ) ) »CSS (EL ( IT , IS ) ) 
XYZTRU(ID,3.IR,IS)  a  R6(IT, IS)*StN(EL (IT, IS) ) 

C  GET  NOISY  STABILIZED  RANGE, AZ, EL. 

CALL  ST*62(IT.IS,tR) 

XYZH8(ID,I,1R,IS)  a  RG ( IT, IS ) *S IN ( AZ ( IT , IS) )  *  COS (EL ( IT , IS ) ) 
XY2HS(10,2,1R,I8)  a  R0(lT,I8)*C0StAZ(lT,IS))  a  CSS (EL (IT , 18) ) 
XYZHS(10,3,IB,I8)  a  RG(lT,IS)aSIN(EL(IT,IS)i 
THS(I0,1R,I8)  a  THRK(ISEC,IR,IS) 

ID  a  LNKBtN(IO,IR,lS) 

GO  TO  10 
too  CONTINUE 
RETURN 
END 
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0044 


SUBR0U7INE  8TAR2(I,J.K) 

COHHeN/NEM/AZ(20,201»R6(20,20).EL(20,20) 

CnHM0N/R«NDUH/I4*R(20>3) 

COMMON/NDECK/AZNO (20,3,3), ELNO(20,3.3)rRNRD (20,3, 3) 
COMMON/R«OI*N/XX(24,20),VV(20,20),SS(20,20) 
COMM0NyPAR2/SL4T(2O),S(.e6(2O),SHT(2n),SHO(20) 
COMMON/COVl/  StG*ZD(20,2),8ieELD(20,2),RHflD(20,2) 
COHMON/PARZ/  RaLL(20),PI7CH(20),RPHA$E(20),PPHASE(20) 
CepM0N/NEW2/  AZ0(20,20),EL0(20,20),SL0AZ(20,20) 
OIMENSIOK  RANdOO) 

RAD*. 01745324252 
PI  a  3.141542654 
CALL  8ETVR(IRAN(I,J)) 

NNh  a  6 

call  VRAKF(RAN,NNN) 

ARO  ■  •2.AAL0G(RAN(t)) 

RNO  ■  SQRT<aRC)-  CeS(6.2832*RAKi(2)) 

AZR  a  ATAN2(XX(!,J),YV(I,J))  aSICAZD(J,K)aRND*RAD 
ARC  ■  •2.*AL06(RAN(3)) 

RND  a  SQRT(ARG}a  CnS(6.2832*RAN(4) > 

ELR  a  ARSIN(SS(I,J))  «SIGELD(J,F)*RND*R4n 
ARC  a  •2.*AL0G(RAN(5)) 

RND  a  SORT(ARG)a  C0S(6.2832*RAN(6)) 

IRANN  a  RAN(6)*10000. 

IRANN  a  (IRANN*2)«1 

IP(1RANN.EQ.1RAN(I,J))  IRANNalRANNtl 

IRAN(I,J)  a  IRANN 

R6(I,J1  a  RG(I,J)  *  RH8D(J,K)*RND 

AZN0(I,J,K)  a  AZR 

ELN0(1,J<K]  a  ELR 

RNND(I,J,K)  a  RG(I,J) 

RR  a  R9LL(J)aRA0 
PP  a  PITCH(J}*RAO 

Xa>SIN(RR)ASIN(ELR)tCOS(RR)aSIN(AZR)AC0S(ELR) 
CaC0S(RR)A8IN(EI.R)f9IN(RR)A8IN(AZR)«C"S(ELR) 
Y4C0S(PP)*C09(AZR)aC0S(ELR)4S1N(PP)*C 
40  AZCa4TAN2(X,Y) 

AZ(1,J)  a  AZe  4SH0(J)*R4D 

CaC0S(RR)*8IN(ELR)fSIN(RR)ASIN(AZR)*C0S(ELP) 
Sa«aiN(PP)*caS(AZR)*C8S(CLR)4CB3(PP)AC 
100  ELEa4RSIN(S) 

EL(1,J)  a  ELE 

return 

END 
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SUOROUTINE  PREOICdSEC.TR.IS) 

C  SUBROUTINE  PREDIC  OETERNINES  THE  POSITION  OF  TRACKS  AT  The  SECTOR 
C  CROSSING  TIME.  BASED  ON  THIS  PREDICTED  POSITION  IT  ALSO  MAKES 
C  ADJUSTMENTS  TO  THE  SECTOR  TRACK  FILES. 

l0HM0N/0ETECT/XYZH8(2O.3.3«5),TMS(20,3,5).C0VMS(20.3,3.3>5), 

lLSTBIN(64.100.3.S),XS(20).TMRK(64.3.5).TRATC(20).LNKBIN(2a,I,S) 

C0MMSN/DUHSEC/DUH8X(64.5).0UMlD(5t2.5) 

CaHMeN/LINK/LNKFSX,LNKSTS(20,5).DUMST(3,20,S),TRKST(2n,20).PTF8T(2 

10.20)(LNKIO(20),T1MLNK(20.S),ROLLNKC20.S).PITLNK(20,<;),SHRLNK(20.5 

21.X8He(20f20i51.COVSMO(l0.10,20,5),PRECOV(10.10,20.5),MPFLAG(20,S) 

CBHM0N/PRE0IC/RAE0UH(2;6.3«5).XVZDUM(256,3,5) 

DINENSION  X(4),TDUN(256.5) 

INTEGER  DUMSX.DUMI0,PTFST,TRK8T 
PI  ■  3.141342654 
TOPI  ■  PI«2. 

NT  a  DUHSX(ISEC.IS) 

TIME  a  THRKdSEC.IR.IS) 

10  CONTINUE 

IFINT.EO.  0)  GO  TO  494 

R  a  0. 

MT  a  TRKST(NT,I8) 

KS  a  PTFSTCNT.IS) 

IF(KS.EQ.IS)  69  TO  2o 
XT  a  XSHOd.HT.KS) 

VT  a  XSH0(3,HT,K8) 

ZT  a  XSNOCS.HT.KS) 

CALL  TRAN8F(XT,TT,ZT,X(1),X(2),X(3),I8,KS) 

XT  a  XSNOtZ.NT.KS) 

TT  a  XSMfl(a,MT,K8) 

ZT  a  XSN0(6.NT.KS) 

CALL  VTRAN8(XT,YT,ZT,X(4).X(5),X(6),IS,KS> 

60  TO  30 
20  CONTINUE 

Xd)  a  XSHOd.MT.IS) 

X{2»  a  X8HO(3,MT,tSI 
Xt3}  a  X8N0(5,MT,1S) 

X(4)  a  X8H0(2,nT,IS) 

XfS)  a  X8N0(4,nt,IS) 

X(6)  a  X8Nfl(6,MT,I81 
30  CONTINUE 
DO  35  Ial,3 
Jalt3 

XYZ0UM(NT,I,I8)  a  Xd)«X(J)«(TTME-TIMLNK;«T,KS)) 

R  a  Rt  XYZDUM(NT,I,ISJ«XYZOUH(NT,I,iS) 

35  CONTINUE 

NTT  a  DUHIOINT.IS) 

T0UH(NT,IS)  a  TINE 
RAEDUNCNT.l.IS)  a  SORT(R) 

PAE0UM(NT,2,IS)  a  AT 4N2 (XYZDUH (NT , » , 18) , XYZDUM (NT , 2, IS ) ) 
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ORINDLAY 


PREDIC 

CSN 


0Q44 

00«S 

004b 

0047 

004S 

0040 

OOSO 

oesi 

0092 

OOSS 

0094 

0099 

0096 

0097 

0090 

0099 

0060 

0061 

0062 

0061 

0064 

0069 

0066 

0067 

0068 

0064 

0070 

0071 

0072 

0071 

0074 

9079 

0076 

0077 

0078 

0079 

0080 

0081 

0082 

0081 

0084 

0089 

0086 

0087 

0088 

0089 

0090 


TEM  ■  8QRTtX7Z0UH(NT,l»TS)»XVZDUH(KyT»T»I8l  ♦  XVZDUK  (MT»2»  IS) ‘XVZOU 
tM(NT.2.IS)) 

R6EDUM(NT,3.18)  ■  AT«M2(XYZDUH(NT«}.IS),TEm) 

IF(RAEDUP(NT,2,I8).6E.  O.)  GO  TO  90 
R6E0UH(NT,2.IS)  «  RAEDl.M()«T,2>IS)  *  TOPI 
GO  TO  60 
90  CONTINUE 

rr(RAC0U*'(NT,2.r8).LE.T0PI)  GO  TO  60 
R*E0UHINT,2.1S)  ■  R*E0UM(NT,2,IS)«  TOPI 
60  CONTINUE  . 

IFdSEC.EQ.l  .AND.  RAC0UH(NT,2,I8).GT.Pn  SO  TO  666 
1F(I8EC.EQ.64  .and.  RAEDU**(NT,2,I8).LT.P1)  GO  TO  777 
AZSEC24  ISEC*(T0PI/6a.) 

AZ8EC|a(lSEC-t)*(T0Pl/64.t 
IF(RAEQU*'(NT,2>1S).GE.AZSEC1)  go  to  70 
ISH  ■  ISEC«t 
669  CONTINUE 

AZSECM  a  (ISM.t)*(T9Pt/64) 

IF(RAE0UPtNT,2.I8).6E.*ZS£CP)  GO  TO  667 
ISH  a  1SH«> 

GO  re  669 
667  CONTINUE 

CAU  0UNCRP(NT«1SEC«IS} 

CALL  0UHNEW(NT,ISH,I8) 

GO  TO  90 
To  CONTINUE 

IF(RAE0UP(NT«2«IS).LC.AZSEC2)  GO  TO  90 
ISP  alSECAl 
69  CONTINUE 

AZSECP  a  ISP*(T0PI/64.) 

IF(RAECIUP(NT,2,IS).U.AZSECP)  GO  TO  778 
I$P  a  ISPfl 
GO  TO  69 
778  CONTINUE 

CALU  0UH0RP(NT.ISEC,I8) 

CALL  OUNNEN(NT,ISP»IS) 

90  CONTINUE 
NT  a  NTT 
GO  TO  10 
666  CONTINUE 
ISM  ■  64 
GO  TO  667 
777  CONTINUE 
ISP  a  1 
60  to  778 
999  continue 
RETURN 
END 
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C8N 


0001 

0002 

OOOS 

0004 

0008 

0006 

OOOT 

0006 

4000 

0010 

0011 

0012 

0011 

0014 

0018 

4016 

OOIT 

0019 

0010 

0020 

0021 

0022 

0021 

0024 

0028 

0026 

0027 

0029 

0020 

0030 

0031 

0032 

0033 

0034 

0038 

0036 


0037 

0039 

0030 

0040 

0041 


SUBROUTINE  CORRASdSHIP.tSEC.IRAO) 

C0MKi0N/0ETeCT/*y2t<8(2O,l,l,5),TMS(20,l,8),C0VMS(20,3,3,l.S>f 

lLaTBXN(64,100.3.S)»XSf20),THRK(64.1,8),TR4TC(20),LNKBIN(2n,l,8) 

C9l>MeN/NOEC4/4ZND(20,8,3),ElND(20.S,l).RNND(20,8,l) 

CaHMON/DUNSECyOUHaX(64«8)«OUHlD(812«8) 

COMM0N/PflC0IC/R4EOUM(286>1.8),XVZOUH(2;6.1.8) 

C6PN9N/CORAS/OETaX(2S6).ISTOR(286),t)ETID(8t2) 

JM0N/L0*O/X8*V(l,20,3),*ZINT{l,S),RVEL(l,8),HNGOIHf5,3) 
MaN/OI8T/SO(386) 

EGER  CUMtO«OUM8X,orTSX.OETIO,TPATG 
EN8I0N  IRA0ET(t0),SCIST(10) 

K  TR4CX8  OUT  OP  OU«o»  SECTOR  FILE 
•  OUMSXCISEC.ISHI*) 

TINUE 

E  ALL  The  tracks  in  this  sector  been  CONSIdeREO 

NT.EO,  0)  GO  TO  444 
TINUE 

■  PETSXINT) 

LOC.EQ.O)  GO  TO  100 
OETSX(NT)  ■  OETIO(LOC) 

DETID(LOC)  ■  0 
lORP  ■  0 

call  NEmLOC(LOC.IORP) 

GO  TO  200 
300  continue 
00  9  laltio 
SOISTd)  *  0 
0  CONTINUE 

C  FIND  RANGE  BIN 

JRN6  ■  RAEDUM(NT,l,tSHIP)/RNGniM(ISMlP,TRAr)) 

C  start  PICKING  DETECTIONS  OUT  OF  RANGE  BINS 
K  I  I 

DO  40  llal«3 
DO  40 

J  aJRNG>2AJJ 

I  ■  1SEC«2a1I 

IF(I.EO.O)  1164 

IF(J,LE,0)  GO  TO  40 

IDETNO  a  LSTBIN(I.J,iRap,IShIPJ 

10  continue 

C  ARE  there  any  detections  LEFT  IN  BIN  l,J 
IF(IOETNfl.EG.  0)  GO  T"  <10 

CCC  IF  PREPIC  H»S  MOVED  TRACK  INTO  NE"  SECTOR  IT  HAY  HAVE  BEEN  PREVIOUSLY 
CCC  ASSIOIATED  WITH  THIS  DETECTION 

IF(TRATG<IDETNO).EO.NT)  G"  TO  40 

c  order  detections  according  to  statistical  pistance 

NN  a  K 

call  C0V0WN(IRAC,ISHIP,IDETNO,NT,Sni , ISFC) 

20  CONTINUE 

IFfNN.EO.n  GO  TO  30 
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ORINDLAY 


CDRKAS 

CSN 


0042 

0043 

0044 

004S 

0046 

0047 

0040 

0044 

0050 

OOSt 

0052 

0053 

0054 

0055 

0056 

0057 

0050 

0054 

0060 


0061 

0062 

0063 

0064 

0065 

0066 

0067 

0068 

0069 

0070 

0071 

0072 

0073 

0074 

0075 

0076 

0077 

0076 

0074 

0080 

0081 

0062 

0083 

0084 

0085 

0086 

0087 

0088 

0089 

0040 

0041 

0092 


lF(S01.6T.SD3aT(NN«lJ)  CO  TO  30 
SOISrihN)  a  SOIST(nm.I) 
tR40ET(NN)  a  IRiOCT(NN«t) 

NNa  NN«1 
GO  TO  20 

3n  SOIST(NN)  a  SOI 

IR40ET(N6)  a  tOETNO 

tOETNO  a  LNKBtM(I0ETNO,lR*D,18HIP) 

K  a  K4l 
60  TO  10 
40  CONTINUE 

C  MERE  THERE  any  DETECTIONS  IN  CONT.  BINS 
IF(K.NE.l)  GO  TO  60 
41)  CONTINUE 

NT  a  DUHIOINT.ISHIP) 

GO  TO  5 
60  CONTINUE 
J  a  K.] 

TO  CONTINUE 

IFIJ.EG.O)  CO  TO  80 
C  PLACE  detections  IN  LINKED  FILE 

c  shallest  so  is  last  one  in 

lORP  a  1 

CALL  NEHLOCaoC.IPRP) 

IST0R<L8C)  a  IRADET(J) 

OETID(LOC)  a  DETSX(NT) 

OETSX(NT)  a  LOC 
SD(LOC)  t  SOIST(J) 

J  «  J<1 
GO  TO  70 
80  CONTINUE 

C  ASSeClATlAN  PROCESS 

NTA  a  NT 
90  CONTINUE 

LOC  •  OETSXtNTA) 
lOETNO  a  ISTORCLOC) 

C  are  any  other  tracks  associated  NITM  THIS  DETECTION 
IF(TRaTG1I0ETN8).NE.  0)  GO  TO  lOO 
TRATGCIOETNO)  a  NTA 
CO  TO  50 
100  CONTINUE 

NTT  a  TRATG(IOETNO) 

LOCC  a  OETSX(NTT) 

IF(80(L0C),6E.S0(LeCC))  GO  TO  no 
TRATG(IOETNO)  a  NT« 

NTA  a  NTT 

110  continue 

LOC  a  D6T8X(NTA) 

0ET8X(NTA)  a  OETIO(LOC) 

IF(0ETSX(NTA).E0,0)  go  to  50 
lORP  a  0 

CALL  NENLOCILOC.IORP) 

GO  TO  40 
944  continue 

return 

END 
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1)001 

0002 

OOQJ 

OOOtt 

0005 

0006 


0007 

0000 

0000 

OOtO 

0011 

0012 

0015 

0014 

0015 

0016 

0017 

OfllH 

uOlO 

0020 

0021 

0022 

11021 

0024 

0025 

V026 

0027 

0«2» 

0024 

0030 

0031 

0032 

0033 

0034 

0035 

0036 

«0I7 

003S 

0034 

0040 

0041 

0042 

0043 

0044 

0045 

0046 

0047 

0048 

0044 

0050 

0051 

0052 

0053 

0050 

0«55 

0056 

0057 

0058 

0054 

0060 
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SUOPOUTTHf  CflWOUK(IR*0#18HtP,IOETNO,KlT,80»t8EC) 

C«HMnN/«»*R7/  l»OLLr2<*).PlTCHf20),RPH*8Er20),PPH*8E(20) 

C8MM0N/K4L2/  P8(2«,20),PP(2«*20)*COV8(20,20)fCBV)*(20,20)»XP(20) 
CSMM0N/iC4L4/IPIRST(2O.5)tOlP|>niM2,0IM3 

C8«P0N/neifIL/I0ET{3,5),I!)T*(256,5,5)  »»««»#» 

C«MM8N/LI»<P/LN8FSX,tNt(8T8(20,5).0U»'8T(5,2O,5),TRK8T(20,20),PTPST(2 
10,201.LN81P(20),TIMLNK(20,5),RnU*'K(20,5),PITLNK(20,5),5HOLNK(20,5 
2) f*S“0(*«» 20*5 »,C0VSM«<t 0,1 0,20, 5) »PPEC8V n 0#  «0»20»5),PPPL 46 (20,5) 
C0MM0N/UP04TE/IL0C(20),TIML46,TESTf t512,3),TL48T(256,5) 

CnMMnN/8T4TrC/N(0),R2(3> 

C8KH0M/P»H2/8U*T(20),8t"e(2«),SHT(20),8H0(20) 
C8MP0N/t,C£C'</*ZKn(20,5,3),EL*)D(20,5,3),RNND(20,5,3) 
(;4|,MnN/OETeCT/XY2)<8<2O,3,3,S),T**S(20,3,5),C0VMS(20,3,3,3,5), 
1LST8IN(6«,  100,3, 5), XS(20),THPK (44, 3,5)  ,TRAT6 (20 ),LN*<B1*i (20,3,5) 


COM'HON/l.opE/NUf'TAR 

DINENSIO^  H(3,3),P<3,3),HP(S,3),4JS(3,3) 
0IHENS18N  *2(3,3),NN2T(4,4),8UH2(3,3) 
REAL  N,ki2,NNT,nn2T 

TKTEGER  TRKaT,0I“l,01*'2,0IKS,PTFST,0UP8T 
RAP  ■  .01745324252 
MT  «  TRAST(NT,ISHIP) 

KSHIP  a  PTFST(NT,I8HtP) 
tF(FSHIP.RE.ISHlP)  G9  TO  85 


JJ  a  18RIP 

no  120  Ial,3 
no  120  Jat,3 
H(1,J)  a  0, 

120  COMTIRUE 

H(t,H  a  CPS(8MC(JJ)*RaP) 

R(t,2)  a  SIN(8H0(JJ)*RAn) 

H(2,n  a-SIN(SHO(JJ)ARAP) 

H(2,2)  a  H(1,l) 

H(3,3)  a  I. 
pniRAD  a  flouL(JJ)*RAO 
PITRAO  a  PITCH(JJ)AflAO 
P(l,l)  a  C«8(»«LPA0) 

P(t,2)  a  0. 

P(1,J)  a  .SI»((»8t»A0) 

P(2,l)  a  8IN(R9LRA0)a  SlN(PITRAO) 
P(2f2)  •  COS(PITRAP) 

P(2,3)  a  C"S(R"LRAP)«  $tN(PlTR4D) 
P(3,n  a  S1N(R8LRAD)«  CRS(PIT«AD) 
P(3,2)  a  •SXN(PITR40) 

P(3,3)  a  C«9(R0LR40)»  C88(PITRA0) 

DO  130  111, 3 

DO  130  Jal,3 
HP(I,J)I  0. 

DO  130  IJal,S 

HP(I,J)  a  HP(I,J)7  R(t,lJ)a  P(IJ,J) 
130  CONTINUE 


IFCIOETnO.NE.O)  go  to  144 
C  CALL  FPON  load 
IT  a  NUNTAH 
GO  TO  148 
(44  CONTINUE 

IT  a  IOT4(IOETN8,IRAO,I8NIP) 

148  CONTINUE 

EL2  a  ELND(IT,I8HIP,IBA0) 

422  a  AZN0(IT,I8HIP,IRAp) 

RN2  a  RNNQ(IT,I8HlP,IRAn) 
42(t,l)a  C08(EL2)*SIN(A22) 
A2(l,2)«  •RN2*8IN(EL2)*SIN(4Z2> 
42(1,3)  a  RN2*C0S(EL2)*Ce8(4Z2) 
42(2,1)  aC08(EL2)»CO8C4Z2) 
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aiUNDLAY 


cevoNN 


C9N 

0961 

A2(?,2)4  •RN2*SIN(EL2)*ceS(A22) 

0062 

A2(2>3)4  •nN2*C08(EL21*SIN(AZ2) 

0063 

A2(3>n«  StN(CL2) 

0064 

A2(3(2)4  RN2*C08(EL2) 

006S 

A2(3f 3)10. 

0066 

on  150  III, 3 

0"67 

00  150  Jal,3 

0066 

AJSdfJl  a  0. 

0069 

00  150  IJ  al,3 

0070 

AJSd.J)  a  «JSd,J)  *  MPd,lJ)*A2dJ>J> 

0071 

150 

CONTINUE 

0072 

on  30  la], 3 

0073 

00  30  Kal,3 

0074 

NN2Td,K)aQ. 

0075 

30 

CONTINUE 

0076 

on  40  lal,3 

0077 

NM2Td,naN2d)*N2d) 

0078 

40 

CONTINUE 

0079 

on  70  lal,3 

0080 

00  70  Jal,3 

0081 

SUM2d,J}ao. 

0082 

on  70  lJal,3 

00  }3 

SUM2d,J)asUM2d,J)«AJSd,IJ)*NN2TdJ,J) 

0084 

70 

CONTINUE 

0085 

on  80  lat.3 

0086 

00  80  Jal,3 

0087 

COVMd.J)  a  0. 

0088 

on  80  IJal,3 

0089 

COVMd.J]  a  COVMd.J)  *SUM2(I,IJ)*AJS(J,IJ) 

0090 

80 

CONTINUE 

C  CALL  FROM  L080 

009t 

IFdOCTNO.EO.O)  60  TO  100 

0092 

00  85  Ial,3 

0093 

09  85  Ja],3 

0094 

CflVM8(I0ETN",l,J,I(»40,ISHIP)  a  COVMd.J) 

0095 

85 

CONTINUE 

0096 

ZMt  a  7Y2MS(l0ETNn.|,iR80,lSHlP) 

0097 

ZM2  a  XVZM8dOETN8,2,IR»c,I8HIF) 

0098 

ZM3  a  XVZMsdOETNn,3,iR*o,ISHIP> 

0999 

KFLAC  a  2 

0100 

IF(K8HIP,ER.ISHIP)  60  TO  88 

0101 

X  a  ZM| 

0102 

Y  a  ZM2 

0193 

Z  a  ZM3 

0104 

call  TR8N8F(X,Y,Z,ZM1,ZM2,ZM3,KSHIP,IS>‘IP) 

0105 

CALL  CnvLNKd8MIP,IOETNO.IRAO.K8MIP) 

0106 

88 

continue 

0107 

NNT  a  0UMST(K8MIP.MT,K8HIP) 

0108 

TOEL  a  TM8d0ETN0,IR*O,I8MIP)  .TIMLNK  (MT,K8HIP) 

0109 

00  66  lal,6 

0110 

X8d)  a  XSMOd.MT.xSMIP) 

0111 

on  66  Jal,6 

0112 

P8d#J)  a  COVSMOfl.J.MT.KSMlP) 

0113 

66 

continue 

0114 

IFdFlRST(MT,K8HIP).NE,0>  GO  TO  90 

0115 

XPd)  a  XSM0(1,MT,K8HIP) 

0116 

XP(3)  a  XSMOCS.mT.mOHIP) 

0117 

XP(5)  a  X8mO(5.mT,kSmIP) 

0118 

90 

continue 

0119 

CALL  X*LMAN(TnEL,“T,ZMl,ZM2,ZM3,K8MlP,KFLAC.80) 

0120 

100 

continue 
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CSN 


0001 

0002 

0003 

0004 

0003 

0006 

0007 

0000 

0009 

0010 

0011 

0012 

0013 

0014 

0015 

0016 

0017 

0010 

0014 

0020 

0021 

0022 

0023 

0024 

0025 

0026 

0027 

0020 

0029 

QUO 

0031 

0032 

0033 

0034 

0035 

0036 

0037 

0930 

0039 

0040. 

0041 

0.042 

0043 

0044 

0945 

0046 

0047 

0040 

0049 

0050 

0051 

0052 

0053 

0054 

0055 

0036. 

0057 

0050 

0059 


SUBROUTINE  COVLNNIKS.tC. IR.JSHIP) 
C9NN0N/N0ECK/*2NO<2O,5,3),ELNO(2n,5,3),RNNOC2»,5,31 
C0NM8N/OETFIU/I0eT(S,«:),IOT*  (256,3,5) 

CSNHBN/ST4TZC/N(4),N2(3) 

C9MMBN/K4L2/  PS(2<!s2.0),PP(20,20),C0VS(20,2O),C0V«(2O,20),1<P(2P) 
CBH09N/NEW2/  *ZD'.;2ir, 20)  .EL0(20, 2c )  ,9L06Z  (20,20 ) 
C0MM9NyUP04TE/IL9C(20),Tl**L»G,TFST"(512.3),TL*ST(256,5) 
C9HM9N/P4R7/  ROLt(20),PITCH(20),RPH*SE(?0),PPHASF(20) 
C9t«N0NyP»B2/SL4T(20),SLOG(20),SHT(20),SH0(20) 

DIMENSION  H(3,3),P(1,3),MP(3,S),THP(S,3),4JS(),3) 

DIMENSION  *(3,9),A2(3,3),NNT(4,4),NN2r(9,9),T(3,3) 

DIMENSION  SUM(3,9),SUM2(3,3),*NNAt (3.3).ANNA2(3,l),CrV(3,3) 

REAL  L«I,LA2,LA 
REAL  N,N2,NNT,NN2T 
RAO  ■  .01745329252 
JJ  I  KS 

IT  ■  !0TA(Io,tR,K9) 

EL  ■  ELN0(1T,KS,IR) 

AZ  a  AZNO(IT,kS,IR) 

RN  a  RNN0(1T,K8,IP) 

DO  120  lal,3 
09  120  Jal,3 
H(1,J)  a  0. 

<20  continue 

M(t,l)  a  C0S(SH0(JJ)*RAD) 

H(l,2)  a  SIN(8M0(JJ)aRA0) 

H(2,n  a.SIN(SHO(JJ)*RAO) 

M(2i2)  t  H(1,l) 

H(3,3)  a  1, 

8QLRAD  0  R9LL(JJ)aRAD 
PITR40  a  PITCH(JJ)«RAn 
P(l,l)  a  C9S(R0LR*0) 

P(l,2)  a  0, 

P(li3)  a  •SIN(ROLRAO) 

P(2,l)  a  SIN(ROLRAO)«  8IN(PITRaO) 
eC2ii)  9  COSCPITRND) 

P(2,3)  a  C08(R0LRA0)*  SIN(PITRAD) 

P(3»l)  a  5IN(R9LRA0)a  C9S(PITRAD) 

P(3,2)  a  -SIN(PITRAO) 

P(3,3)  a  COSCROLRADla  C9S(PITRAD) 

DO  130  Ia|,3 

DO  110  JaU3 

HP(I,Jla  0. 

DO  130  IJal,3 

HP{1,J)  a  HP(I,J)*  H(1,IJ)«  P(IJ,J) 

130  CONTINUE 

TM2  a  8LAT(JSMIP)aRA0 

L*  a  (9L06(JJ]*RA0)«  (8L0G(JSHIP)*RAD) 

THI  a  SLAT(JJ)aRAO 
TCl.l)  ■  CBS(L4) 

T(l,2)  a  8IN(TMn«  9IN(LA) 

T(l,3}  a  COS(THn*  SIN(LA) 

T(2,l)  a  8IN(TM2).  SIN(LA) 

T(2,2)  a  StN(THt)A  SIN(TN2)*CBS(LA)  *COS ( Th 1 ) *008 (TM2 ) 

T(2,3)  a.C08(THl)*  SIN(TH2)*C05(LA)  aSIN ( Th 1 ) *C0S (TH2 ) 

T(3,1)  ••C0S(TH2)a  SIN(LA) 

T(3,2)  a  C08(THn*  SIM(TM2)  -SINtTHl).  COS ( Th2) aCOS (L A ) 

T(3,3)  a  CBS(TH1)a  C0S(TN2)*C0S(IA)  aSlN (ThI ) »SIN (TH2) 

DO  140  lal,3 
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0061 

0062 

006S 

0060 

0065 

0066 

0067 

0068 

0060 

0070 

0071 

0072 

0071 

0070 

0075 

0076 

0077 

0078 

0070 

0080 

ooat 

0082 

0083 

0080 

0085 

0086 

0087 

0088 

0080 

0000 

OOOt 

0002 

0003 

0000 

0005 

0006 

0007 

0008 

OOOO 

0100 

0101 

0102 

0103 

0104 

0105 

0106 

0107 

0108 

otoo 

0110 

0111 

0112 

0113 

0114 


THP(I,J)«  0. 

DO..  140  IJil.3 

TMPd.J)  a  T(1,TJ)*HP(TJ,J) 

140  CONTINUE 

6(1,1)  ■  T(l,t) 

6(1.2)  a  7(1,2) 

6(1,3)  a  7(1,3) 

6(1,4]  a  7HP(l,l)*CeS(EL)*S!N(6Z)  *7HP ( 1 ,2) *CSS (EL ) aCOS  (6Z )  67HP  ( I  , 

I3)*8IN(EL) 

6(1,5)  a  •THP(1.1)*RN*  S IN (EL) *SIN (6Z )  •  ThP ( 1 , 2 ) *RN*SIN (EL )* 
2C0S(6Z)  «THP(l,3)*RN*CflS(EL) 

6(1,6)  a  7HP(l,t)*RN*CSS(EL)*C9Sr6Z)  •  TnP ( 1 , 2) aRNaCnS (EL ) *SIN (6Z) 

6(1,7)  a-1 

A(l,8)  a  0 

6(1,4)  a  0 

6(2,1)  a  7(2,1) 

6(2.2)  a  7(2,2) 

6(2,3)  a  7(2.3) 

6(2,4)  a  THP(2,t)*C«S(EL)»SlN(*Z)  aTl-P (2, 2 > *C"S (EL ) »C«S (6Z ) ♦ 
3THP(2.3]6SIN(EL) 

6(2,5)  a  -THP(2.1)*»N»SIN(EL)»SIN(6Z)  -  TMP (2, 2 )*RN»sIM (EL )«C0S(6Z 
4)  ♦  THP(2,3)*RN»CeS(EL) 

6(2,6)  a  THP(2,l)«RN*C«S(EL)»CfiS(*Z)  -  TNP(2,2)»4N*CaS(EL)«SIN(4Z) 
6(2,7)  a  0 
6(2,8)  a  -1 

6(2,9)  a  0 
6(3,1)  a  7(3,1) 

6(3,2)  a  7(3,2) 

6(3,3)  a  7(3,3) 

6(3,4)  a  TMP{3,1)*C«S(CL)»SIN(6Z)  ♦  7 ( 3,2) aCBS (EL ) ‘COS ( 6Z ) ♦  THP(3, 
53)*  SIN(ei) 

6(3,5)  a  -THP(3,n*RN*SIN(EL)*SIS(*Z)  -ThP (3,2) aRNaSTN  (EL ) »CeS(6Z) 
6*  THP(3,))»RN*C8S(EL) 

6(3,6)  a  •TMP(3,1)»RN»C8S(EL)*C88(6Z)»Thp(3,2)  •RN*Cr$(EL)»SIN(6Z) 

6(3,7)  a  0 

6(3,8)  a  0 

6(3,9)  a.l 

00  10  I«l,9 

00  lU  Kal,9 

NN7(I,K)a0. 

10  CONTINUE 
DO  20  lal,9 
NNT(I,I)aN(I)*N(I) 

20  CONTINUE 
00  50  IBI,3 
DO  50  Jal.9 
SUP(1,J)*0. 

DO  50  IJal,9 

SUM(I,J)a3UN(I,J)*6(I,IJ)*NNT(IJ,J) 

SO  CONTINUE 
90  continue 
00  60  I«1.3 
DO  60  Jal,3 
COVPCI.J)  a  0. 

00  60  IJBl,9 

COVN(I,J)a  COVH(I,J)  ♦  SU'*(I,IJ)*6(J,IJ) 

60  CONTINUE 
45  F0RN6T(5X,9F14.3,//) 

RETURN 

END 


90 
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OOOt  SUBROUTINE  K*U’<*N(TOeL,IT*R»ZNlirH2t2:M3.lSHlP,KFt*6*SO) 

O002  COMMON/OETECT/KYZNSfiOfJ/S.SJ.TMSTZO.SfST/COVMSCao.S.S, Jf5). 

1l.8TBlNf6a,100,3,S),XSC20),THRK(6«.S.5),TRATGf20),LNKPIN(20,3»5) 
0003  GQNRON/KALt/  PHt(2o,20).6(20<20)«Hr20t20) 

0004  COHMON/KAL2/  PS (20,20 ) ,PR (20,20 ) ,C0V8 (20 , 20 ) ,C»VM (2o ,20 1 , XP (20 ) 

0005  COMMON/K  *L4/IF  IRST  (20, 5),  r>IPl,eiH2,0IHS 

0006  CCHHON/TRIANG/  COVl (20,20) ,UP (20 ,20 ) ,FL (20 , 20 ) 

O007  COH«0N/INVeRT/R(20,2O),RI(2O,20) 

0008  OIPENSION  XPMiJ(6 ) , SUM (6 ) ,SUM2 ( 3) , XMMU (3 > 

0004  dimension  ZM(20),mT(20,20) 

0010  dimension  OMt(20,20),OM2(2O,20),CM3(20,20) 

0011  DIMENSION  VOCI(3,3),03M(3,3),n?M(3,3) 

0012  dimension  0«M(6,6),05M(6,6),VOC2(6,6) 

0013  INTEGER  OIMi ,d1»2,PIM3 

0014  ZM(n  ■  2MI 

0015  ZM(2}  ■  2M2 

0016  ZM(3)  «  ZM3 

0017  M  a  dIM-I 

0018  N  a  0IM2 

0014  NS  a  01M3 

0020  JEIHST  a  IF IRST ( ITAR, ISMIP) 

0021  IF(JFIR8T.LT.  2  .AND,  KFLAG  .EO.  P)  G«  TO  1244 

0022  IF(JFTRST)  10,165.100 

0023  <0  continue 

C  FIRST  TIME  THRU 

0024  DO  120  tat,N 

0025  00  120  Jal,N 

C  SMOOTHED  covariance  MATRIX 

0026  P8(I,J)  a  <) 

0027  120  continue 

0028  P8(1,n  a  COVM(i,n 

0024  P8(3,3)  a  C0VM{2,2) 

0010  P$(S,S)  a  C0VM(5,3) 

0031  P8(1,3)  a  C0VM(1,2) 

0032  P8(3,l)  a  PS(1,3) 

0033  P8(l,5)  a  CflVM(t,1) 

0034  P8(5,t)  a  PS(1,5) 

0035  P8(3,5)  a  C"VM(2,3) 

0036  PS(5,3)  a  P8(S,5) 

C  PREOICtEO  POSITION  VECTOR 

0037  00  I6U  Ial,N 

0038  XPII)  a  XS(I) 

0034  160  continue 

0040  GO  TO  120n 

0041  165  CONTINUE 

g  second  time  thru 

0042  PS(2,2)  a(COVMCl,i)A  PS (I , 1) ) / (TOELaTOEL) 

0043  P8(2,4)  a  (C0VM(|,2)t  PS(1 ,3) )/(TOELaTOEL ) 

0044  P8{4,4)  a  (C0VM(2,2)»  PS (3, 3 ) > / {TOEL»TOEL ) 

0045  P8(2,6)  a  (cavM(|,3)A  P8( 1 , 5) )/ (TOELaTOEL ) 
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0006 

0047 

0048 

0040 

0050 

0051 

0052 

0051 

0054 

0055 

0058 

0057 

0058 

0050 

0060 

0061 

0062 

0061 

0064 

0065 

0066 

0067 

0068 

0060 

0070 

0071 

0072 

<1071 

0074 

0075 

0076 

0077 

0078 

0070 

0080 

0081 

0082 

0081 

0084 

0085 

0086 

0087 

0088 

0089 

0090 

0091 

0092 

0091 

0094 


8S(4,a)  t  P8(2,4) 

P8f6,2J  a  P8(2,6) 

PSll.n  a  CSVMd.i) 

98flt2)  a  C9VM(l,n/TDEL 
PS(2,t)  a  PS(I,2) 

PSd  ,1)  a  C0VM{i,2) 

PS(3,n  a  P8(l,l) 

PSt4,6)  a(C8VM(2,l)4  PSf3,5J)/(T0EL*TDEL) 
r3(6i4)  a  PS(4,6) 

PS(6,6)  a  (C8vm{1,J)»P8(5,5))/{T0EL«T0ELJ 
PS(1,41  a  C"VM(i,a)/TnEL 
PS{4,1)  a  PS(t,4) 

PS(2*1)  a  CeVM(t,2)/rOEL 
PS(1,2)  a  PS(2,1) 

PS(1,3)  a  C8VM(a,a) 

PS{1,4)  a  C8VM{a,a)/TD£L 
PS<4,3)  a  PSt3,4) 

PS(1,5)  a  C8VM(i,3) 

PStSil)  a  PS<t,5> 

PS(2»5)  a  C9VM(1 ,3)/tOEL 
PS(5.2)  a  PS(2,5J 
PS<3,5)  a  COVMfj.j) 

PS(5»1)  a  PS(3,5) 

PS(a,5)  a  cavp(?,3)/fPEi. 

PS(5,4)  a  PS(4,S) 

PS(5.5)  a  C8VM(3,3) 

8Sn#6)  a  CnVP(l  .D/TDEL 
PS(6, I)  a  PS( t (6) 

PS(1,61  a  CflVPta.D/TPEL 
P8(6,l)  a  P8(3,6) 

PS(5i6)  a  C9V“(3»3)/tDEL 
P9(6»S)  a  PS(5,4) 

99  tSS  Ial,N 
09  155  Jal,N 

C  PPEOICTEO  C9VAPT4NCE  MaTRIK 
PP(I».IJ  a  PS(I,J) 

155  CONTtNue 

0"  I70  Ia),N 
09  170  Jal,M 
0M| (t,J)aO. 

0"  170  Kal,N 

OMHl.J)  a  081(1, »  PSn»K)*H(  J.K) 

170  CONTINUE 

09  1*0  Ial,M 
0"  1*0  Jal,4 
COV I ( I , J )  a  C9VH (T, J) 

180  continue 

CALL  ilPPERTfP) 
no  190  Ial,M 
0"  190  Jal.M 


A0-A079  951 
liNCLASSIFIED 


NAVAL  RESEARCH  LAS  MASH1N5T0N  DC 
MULTIPLE  PLATFORM  SENSOR  INTE6RATI0N  MODELS 
DEC  79  A  6R1NOLAY 
NRL-B358 


F/B  9/2 
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NL 
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004^ 

■  UP(J.I) 

004A 

I40 

CONTINUE 

0047 

CALL  IKVERLIM) 

0044 

00  14S  14I«M 

0044 

00  14S  J«1,M 

oton 

0M2CtfJ)  4  0. 

otot 

0«  145  KII.M 

Ot02 

0**2(I,J)  •  OMPd.JI  ♦«1<1.K)*RI(J.*') 

0t03 

145 

CONTINUE 

0104 

CO  215  Ia*»N 

otos 

no  215  Jal,M 

01 04 

NTd.J)  a  9. 

0107 

DO  215  Kal.M 

0100 

47(1, J)  a  WT(I,J)  tPM1(1,K)*DM2(K,J) 

0104 

215 

continue 

olio 

GO  TO  040 

0111 

100 

continue 

C 

SEt  UP  transition  natpik 

0112 

no  IQS  lat.N 

0113 

DO  105  Jal,N 

0114 

PMKI.J)  a  0. 

Oils 

PMKI.n  a  1. 

Ul  14 

195 

CONTINUE 

0117 

PHI(1,2)  a  TOEL 

QUO 

PH1(3,4)  a  TDEL 

0114 

PNI(S,4)  a  TOEL 

c 

COMPUTE  PPEOICTION  covariance 

0120 

W 

00  ISO  lal,N 

0121 

00  ISO  Jal,N 

0122 

OMKI.JIaO. 

0123 

00  ISO  Ka1,N 

4124 

ISO 

OM|(t,J)aOM|(I,J)4PS(I,K}aPHl(J,M) 

012S 

00  210  Ial,N 

0124 

00  210  Jal,N 

0127 

OM2(t,J)aO. 

0120 

00  209  Kat,N 

0124 

200 

ON2{l,J)aOM2(I,JMPNI(I,K)»OM|(K,J) 

0130 

210 

P»(I>J)aOM2(l,J) 

0131 

lE(NS)  320,320.240 

0132 

240 

CONTINUE 

0133 

00  250  lal.NS 

0134 

00  250  Jal.N 

0I3S 

OMKX.Jlao. 

0424 

00  250  Ka-trNS 

0137 

2S0 

OMl(I,J)aDMl(I,J>TCOV$CI,K)a6IJ,K) 

0130 

00  310  lal.N 

0134 

00  310  Jal.N 

0140 

OM2(I,J)aO, 
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KALHAN 

CSK 


uiai 

ot«2 

oi»1 

ot«« 

0145 

0146 

0(47 


o(<ia 

0104 

ol!0 

otsi 

0I«2 

n^%^ 

olS« 

0I«9 

fl1S6 

0t«7 

on* 

0154 

0160 

0161 

0162 

0163 

0164 


0165 

0166 

0167 

0166 

0164 

0170 

0171 

0172 

0171 

0174 

0175 


0176 

0177 

0178 

0174 

0180 

01*1 


on  300  Ka(|NS 

100  0*'2(I.J)«C42«t»J7*G(l.»l»e*«l  14,J) 

310  PP(t#Jl4P»»(T.J)*0f2ft,J) 

320  cniill^UE 

pn  315  I«l,N 
on  315  Jal,M 

315  pp<r.J)  »  ppn,Jj*f*pf.05*7efL> 

c 

c  fOPPUTf  FTL7ER  HEIGHTS 
C 

pn  350  lal.N 
no  350  Jal.M 
DHl (1/ J)aO. 

CO  350  Kal,N 

350  PHI (If J)aOMl <T,J)«PP(lfK)*H(JfK) 
no  410  lalfH 
no  OlO  JaUH 
nH2(If J)aO. 

00  400  KilfN 

400  nH2(If J)»0H2(tf J)*H(I,K)*OHl(PfJ) 

410  vncttifj)  a  0H2(I,J)*CflVH(I,J) 

CALL  HAT(V0CI,M,H,nlH,P,P,»>2HtHf“t)l**f 

no  550  lalfN 

no  550  JalfH 

HT(I,>t)afl. 

no  550  Kal,H 

550  hT(I,.I1  a  hT(I,J)*0Hl(I,P)»n2H(4,J) 

c  UPDATE  SHOOTHCO  CnWARtAHC* 

C 

on  600  lalfN 
OS  600  JalfN 
OMKlfJlaO. 

00  too  KaifM 

600  0H1(I»J1«0M1  (I,JJ*>tT(t,a)6M{l«,J) 

DO  660  lalfN 
DO  660  JalfN 

0M2(If J)ao. 

DO  650  KalfN 

650  0M2(If J)anH?(I,J)*0Nl{I»'‘)»44(P»J> 

660  PSCIf J)»RP<If J)*0H2(If J) 

C 

c  FILTER  UPnATE 
C 

DO  400  lalfN 
*P<I)aO, 
no  400  jaifN 

400  XP(I)aXP(n*PHI(I,J)o*8(J> 

040  continue 

00  460  lalfM 
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01(12 

DHKItDiO. 

Dies 

04  430  Jal,N 

01C« 

430 

DM|(I,naDMt  (i,|)6H(t,J)«K2(J) 

oias 

460 

0N2(I.n42M(t)-O»*l(I,|) 

0106 

00  1010  I>t«N 

Otar 

OM1(1,1)bO. 

oiaa 

00  1000  Jai.N 

0t8« 

lOOO 

0M|(I,l)a0Ht(l«l)«NT(I,J)*DN2(J/l) 

0140 

1010 

KS(I)ailP(tl60Mt(I,l) 

0141 

1200 

CONTINUE 

0142 

If(KFI.AG.NE.2)  fiO  TO  1300 

C 

c 

CALCULATE  statistical  CISTaNCC 

0143 

i. 

00  166  Ial,N 

0144 

XPHU(I)  a  .nHKt.ll 

0t45 

00  166  Jat,N 

11146 

vnC2(I.J)  a  PP(I,J) 

0147 

166 

CONTINUE 

014a 

call  NAT(V0C2,N,N,6at<,6,N,05H,N,>.,VyY,4) 

0144 

PARTI  a  0. 

0200 

PART2  a  0. 

0241 

DO  366  lal.N 

0202 

8UN(I)  a  0. 

0203 

366 

continue 

0204 

00  4«6  Ta|,N 

o2oS 

00  466  Jaf,N 

0206 

StINd)  a  StH(t)  ♦»PMUfJ)AD5HfJ>n 

0207 

466 

continue 

o2oa 

00  366  Jai,N 

0204 

parti  a  PARTI*SU»(J)*XRNU(J) 

0210 

366 

continue 

0211 

XMnU(I)  a  2N(1)  .xstn 

02|2 

Xmmu(2)  a  2H(2).  XS(3) 

0213 

XNNUIlla  2H(5)«  «Sf3) 

0214 

DO  666  lal,M 

0213 

SllH2(n  ao. 

02l6 

P"  666  JaUN 

0217 

yOCI(I»J)  a  COVN(I,J) 

021a 

666 

continue 

02l0 

call  MATIVOCI.M.N.OlN.y.H.PEN.H.M.XXX.R) 

0220 

00  066  Ial,M 

0221 

po  066  JaI,N 

0222 

81142(1)  a  SllN2(I)  ♦  xmpU(J)aD2H(J,I) 

0223 

066 

continue 

0224 

00  466  Ja1,M 

0223 

PART2  •  PART?  ♦  8U»'2(J)«xyHU(JJ 

0226 

466 

CONTINUE 

0227 

so  a  PARTI  ♦  PART? 

0224 

CO  TO  1300 

0224 

1244 

CONTINUE 

0210 

SO  a  14. 

0231 

1300 

CONTINUE 

0212 

return 

ORINDLAY 


esN 


ooot 


0002 

0001 

0000 


0005 

0006 

0007 

0000 

0006 

0010 

0011 

0012 

0013 

0014 

0015 

0016 

0017 

0010 

0010 

0020 

0021 

0022 

0023 

0020 

0025 

0026 

0027 

0020 

0020 

0030 

0031 

0032 

0011 

0034 

0035 

0036 

0037 

0030 

0030 

0000 

0041 

0002 

0003 

0004 

0005 

0046 

0047 

0048 

0040 


SUBROUTINE  SORTdSEC.TSHTP.TROC) 

C  SUBROUTINE  SORT  EXAMINES  EACH  TRACK  IN  THE  SECTOR  UNOFR  CONSIDERATION. 
C  IE  THE  TRACE  IS  A  RARTICIRATINr.  memreR  BIAS  ERRORS  ARE  REDUCED. 

C  IE  THE  TRACK  IS  NOT  AN  ONNSHIE  HPT  SURROUTINF  TIHCON  IS  CAILEO  TO 

C  PREPARE  INFO  ON  ASSOCIATED  DETECTION  FOR  TRANSMISSION  OVER  THE  LINK. 

C  IE  THE  TRACK  IS  AN  OmNSHIP  HPT  THE  LINKED  FILE  'TESTO*  IS  LOADED 

C  WITH  INFO  FOR  ACCESSING  DETECTION  FILES.  'TESTO'  CONTAINS  THE  I.D. 

C  NOS. (SHIP  NOS.  AND  RADAR  NOS  OF  ALL  DETECTIONS  THAT  HAVE  RECENTLY 

C  BEEN  ASSOCIATED  WITH  NT.  TESTO  IS  LINKED  BY  FILIO  AND  FILFX 

COHM0N/OETECI/XYZHS(24.3.3,5),THS(2O,3,5)»C0vms(2O,1,S.1.5). 
ILSTBIN(60.100.3,5).XS(2e).TMRK(60,3.5),TRATG(?0).LNKBIN(20,I,0) 
COHHON/UPOATE/ILOC (201 .TIHLAG. TESTS (512.3). TLA8T(2S6, 5) 
C0MM0N/LINK/LNKFSX,LNKST0(2O.5).CUhsT(5.20.S}.TRKST(20.20).PTFST(? 
10.2Ql.LNKI0(24).TIMLNK(20.51.ReLLNK(2O,5l.PXTLNK(2P.S).SHCLNK(2O.5 
2).XSM0(20.2(l.5).C0VSMfl(l0.1fl.20.S).PRECOV(10.10.20,S).HPFL*6(20.5) 
C0HH0N/CSRAS/DCTSX(256).IST0R(256),DETID(5t2) 
CRHH0H/PAR2/SLNT(20).SLO6(2O).3HT(2O).SHDt2O) 

C0HH0N/PAP7/  ROLL(20).PITCH(24).RPHASE(20).PPHASC(20) 
COMHON/OUHSEC/OUHSX(A4.5).OUMID(512.5) 
CeHHeN/N0ECK/AZN0(20.S.3).ELND(2(l.5.3).RNN0(2n,5.1) 
COHHON/RANTIM/TRAN(20.I.5) 

CeHHON/DIST/SO(256) 

COHHON/SORT/FILFX(256.5).F1LID(512) 

DIMENSION  RANDClOei 

INTEGER  OUMSX. OETSX.PTFST.TRKST. TESTO. Fit  ID. FILFX. CUMIO 
NT  ■  DUHSX(ISEC.ISHIP) 

10  CONTINUE 

IFCNT.EQ.O)  GO  TO  040 
LOC  ■  OETSX(NT) 
lOETNO  a  ISTOR(LOC) 

C  ARE  there  any  detections  associated  with  track  NT 
IF(IOETNO.EG.O)  go  to  20 
KS  a  PTFST(NT.ISHIP) 

HT  a  TRK8T(MT.1SHIP) 

C  mPFLAG  a  1  INDICATES  PARTICIPOTING  PLOTFORO 
IF(HPFUAG{mT.kS).ne.O)  CO  TO  30 
IF(K8.EQ,I8MIP)  go  to  «0 
ROLLNKdOETNO.ISHIP)  a  ROLLdSHIP) 

PITLNKdCETNO.ISHIP)  a  PITCH(I8HIP) 

SMOLNKdOETNO.ISHIP)  a  SHD(ISHIP) 

CCCC  INSERT  random  DELAY 
NNH  a  1 

CALL  VRANF(RANO.NNN) 

TRAN(IDETNO.IRad.ISHIP)  a  (RAND(I)aI. 0)0.1  oTMSdDETNO.lRAD.ISHlP) 
SOIST  a  80(LflC) 

CALL  TIMCONCIDETNO.mt.KS.ISHIP.IRAD.ISEC.SDIST) 

GO  TO  20 
30  CONTINUE 
GO  TO  20 
40  CflHTIKUE 
IDROP  a  1 

CALL  OETLOCINT. LOC. IDROP) 

TESTOCLOC.l)  a  IDETNS 
TC8T0(Lac.2}  ■  ISHIP 
TESTOCLOC.l)  a  IRAD 
FILIOCLQCl  a  FILFX(NT. ISHIP) 

FILFK(NT, ISHIP)  a  LOC 
20  CONTINUE 

NT  a  OUHIOCIT. ISHIP) 

GO  TO  10 
900  CONTINUE 
RETURN 
END 
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0001  SUBROUTINE  TINCON(IOeTNO»MT.K8,I8,IR,ISEC<SOI8T) 

0002  C0R*«eN/HaouL0yiSLeT(20,5*«0)«iKev(S)ti»'0D20»iHee60 

0003  COHMeN/OETECTyXV2M8(20,3,S,S).TH8(2e,3,5).CSVM8(20,S,3r3.S), 

tL8TSIN(64.100.3.S)«XSC20)»TNI)K(«a.S,S),TRAT6(20),tNKRIN(20,3>S) 
0004  CeMMeN/LINK/LNKPrX«LNK8T9(20,5).PUHST(!,20,5),TRti8T(20>20),PTFST(2 

10.20)«LNK10(20),TIHLNKC20,S),ReLLNK(20,S)»PITLNK(20.5)»SHOLNK(20,S 
2)tXSHO(20,20iS)(CeV8H8(10.l0.20,S)«PRECOV(10,l0.20,5),HPFLAG(2a,S) 
OOOS  C0MH0N/UeCLNK/LASlNK,PljLLNK,LI8LNK(20)«NEXLNK 

0006  C«HPON/RANTIN/TRANC30*S«S) 

0007  INTEGER  PULLNK 

0008  ir(PUlLNK.NE.O)  GO  TO  Id 

C  INITIATE  PROCEDURE  FOR  PURGING  FILE 
0000  I  a  1 

0010  10  CONTINUE 

0011  10  a  LNKSTOd.l) 

0012  18  a  LNKaT0(1.2) 

0013  IR  a  LNK8T0(I<3) 

0014  IF(TH8(10«lR«lS).LT.(TNRK(t8EC«IR«IS)>30.))  GO  TO  20 

OOlS  CALI  LNKORP(I) 

0016  lORR  a  0 

0017  CALL  LNKLOC(I.IORP) 

0010  20  CONTINUE 

0010  1  a  I«l 

0020  IF(I.LT.20)  CO  TO  10 

0021  30  CONTINUE 

0022  PRINT  301.TNS(IOETNO,IR<IS).S01ST,tS*TRAN(tOETNO,IR»IS) 

0023  301  FORMA! (/lOX, •DETECT  t IPE * »F10.3,5X, • STATOIST • ,F 1 0. 3 »5X , ‘PLATFORM i , 

llOfSX, 'TRANS  TINE'.F|0.3/) 

0024  ITIME  a  TMS(I0CTN0,IR>1S) 

002S  N9060  ■  POO(niNE«INS060) 

0026  IMOO  a  Ne060  *  I 

0027  IPOOMl  ■  IM0D>1 

003S  IM0DM2  a  IM00«2 

0020  IMOOMS  a  IMOOoI 

0030  XM00N4  a  IMeD«4 

C  ^  TIME  SLOT  IS  FULL  DETECTION  IS  NOT  TRANSMITTED 
0031  IF(I8L0T(MT.KS«IMOOM«).nE.O)  CO  TO  40 

0032  lF(18L0T(PT«KSiIMe0N3).NE.0}  CO  TO  40 

0033  IF(1SL9T(MT«KS«IMOOM2).nE.O)  CO  TO  40 

0034  IE(ISL9T(MT.KS«IP90Nt).NE.0)  GO  TO  40 

0033  IFdSLOTIMT.KSflNODI.NE.O)  CO  TO  40 

0036  MLaTCPT«KS.INOO)  a  } 

0037  IDRP  a  1 

0036  CALL  LNKLOC(LOC.IORP) 

0034  LNKIOILOC)  a  LNKFSX 

0042  LNKFSX  a  LOC 

0041  LNKSTOCLOCf 1)  a  IDETNO 

0642.  1J(KJ10(L0C«2)  a  IS 

>043  LNNST0(L0C,3)  a  IR 

0644.  LNKST0(LeC«41  a  NT 

0043  LNKST0(L0C.3)  a  K8 

0046  40  CONTINUE 

0047  RETURN 

0046  END 
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CIN 


0001 


0002 

0001 

0004 

OOOS 


0006 

OOOT 

0000 

4000 

0010 

4011 

0012 

0013 

OOIO 

0015 

0416 

0017 

0010 

0010 

0020 

0021 

0022 

0023 

0024 

0025 

0026 

0027 

0.020 

0020 

0030 

0031 

0012 

0033 

0021 

0035 


SUBROUTINE  LNKOET(ISMIP.ISEC.IROD) 

C  SUOROUTIkE  LNKOET  PLACES  DETECTIONS  PROM  THE  LINK  IN  THE  TETS  FIlE 

C  FOR  EACH  TRACK  IN  I8EC.THE  DETECTIONS  ARE  ORDERED  IN  TINE  AND 

C  PLACED  IN  THE  HOC  FILE.  LNKDET  CALLS  UPDATE  AFTER  ORDERING  THE 
C  OETECTIONS 

C0HN0N/RANTIM/TRAN(20.3.S) 

C0HHeN/OETECT/XVZNS(2O,3«S»5).TN8(20,3.5).C0VMS(2O,3,3»3«5), 
lLST8IN(e0,lo0.3.5).KS(20)>TNRK(6a,3.5),TPAT6(20).LNKRIN(2O,3.5) 
CONN6N/UPDATE/IL0C(20)»TIHLAG.TESTe(5l2,3).TLAST(256,5) 
C0NH0N/LINK/LNKESX.LNKST0(2O(5),CUmsT(S.2O«5),TRkST(2O>20),PTEST(2 
10.20)iLNKID<20).TIHLNK(20.S),ReLLNK(20,5).PITLNK(20,5)«SHCLNK(20,5 
2 ). XSN0(24,20«S).COVSNe( 1 0,1 0,20,5 1.PPECOVC 10,1 0,20,5 j.NPFl AG (20,5) 
COHHON/DUMSEC/DUHSX(6a,5),OUMln(512,5) 
C0HH0N/SeRT/FtLFX(256,5),FILID(5l2) 

INTEGER  DUHST, TESTS, FlLID,FILFX,nUMSX.nUHlO,PTFST,TRKST 
NT  ■  DUNSX(tSEC,ISHtP) 

IFCNT.EQ.O)  GO  TO  400 
LOC  >  LNKFSX 

C  LNKFSX  IS  THE  LOCATION  OF  FIRST  ASSOCIATED  DETECTION  IN  LINK  FILE 
10  CONTINUE 

C  ALL  link  detections  CONSIDERED 
IF(LOC.EO.O)  60  TO  ISO 
KS  ■  LNKSTO(LeC.S) 

C  DOES  this  detection  CORRELATE  WITH  I8H1P  TRACK? 

IFCKS.NE.ISHIP]  GO  TO  101 
ID  a  LNK8T0(LflC,l) 

IS  a  LNKST0(L0C.2) 

IR  a  LNKST0(LflC,3) 

NT  a  LNK8T0(LflC,«) 

c  IS  detection  associatec  with  Participating  platforn 
IF(HPFLA6{NT,K8),NE,0)  GO  TO  100 
NT  a  DUH|T(K8,NT,I8HIP) 

IF(TRAN{1P,IR,I8).GE,THRK(18EC,1RAD,1SH1P))  go  to  101 
C  NAS  detection  made  before  last  update 

IF(TM8(I0,IR,I8).LC.  TLA8TtNT,I8HIP))  CO  TO  100 
lORP  a  I 

C  GET  nek  location  FOR  LINK  DETECTION  IN  TESTO  FILE 
CALL  DETLOC(NT,LecC,IORP) 

TESTOCLOCC,!)  a  ID 
TCST0(L0CC,2)  a  IS 
TESTOCLOCC.!)  o  IR 
FILIOCLOCC)  a  FILFX(nT,18HIP) 

FILFX(NT,18HIP)  a  LOCC 
100  CONTINUE 

LOCOLO  a  LOC 
LOC  a  LNKIO(LOC) 

CAU-LNUORPCLOCOLD) 

IDRP  a  0 
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LNKDET 

CtN 


ttOSt 

00S7 

0036 

0030 

0010 

0011 

0013 

0013 

OOlb 

lOlS 

0010 

0017 

0010 

0010 

0030 

0031 

0033 

0033 

0031 

0033 

0030 

0037 

0030 

0030 

0000 

oool 

0003 

0003 

0001 

0003 

0000 

0007 

0000 

0000 

0070 

0071 

0073 

0073 

0071 

0075 

0070 

0077 

0070 

0070 

0000 
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ClLt.  CNKUOCtUOCOLO.lDRl) 

60  70  10 
101  CONllNUE 

LOC  ■  LNKID(LOC) 

60  70  10 
130  CaN7tNUE 

C  60  THOU  TRACKS  A6AIN 

NT  ■  OUHSX(ISEC»ISHIR) 

300  continue 
K  ■  000 

XFINT.EQ.O)  60  TO  000 
KSHll  ■  1TPST(NT,I8HIP) 

Xr(KSHlP.KE.lSHIP)  60  TO  300 
NT  ■  T1KST(NT.X8HXP) 

XP(HPFLAG(HT,KSHXP).EQ.0)  go  to  205 
60  TO  370 
203  CONTXNUE 
K  ■  0 

LOCC  ■  FXLPXCNT.XSHIP) 

C  ARE  there  NO  OETECTXONS  ASSOCIATED  WITH  THIS  TRACK 
XF(I.OCC.EQ.O)  60  TO  280 
210  CONTINUE 
K  ■  KAl 
J  a  K 

220  CONTXNUE 
C  FIRST  PASS 

XPCJ.EQ.n  60  TO  260 
c  order  cohbineo  detections  in  time 

10  I  TESTOdOCC.n 
IS  a  TEStO(lOCC.2) 

XR  a  TESTOdOCC.Sl 
XOO  •  TCST0(IL«C{J*1).1) 

ISS  0  TtST0(tCflC<J»lU21 

XRR  a  TE8TO(ItOC(J»l).3) 

IF(TH8(IC,IR,IS),6T.TMS(ID0,1RR,I8S))  GO  TO  260 
ILOCXJl  a  IL"C{J-t) 

J  a  J»1 
60  TO  220 

260  continue 

ILOC(J)  a  LOCC 
LOCC  a  FILXD(LOCC) 

c  have  all  detections  been  OROELEO 
IFXLOCC.NE.O}  GO  TO  210 
270  CONTINUE 

CALL  UPDATE (NT, I8EC.IRA0,I8MIP,K) 

2S0  CONTINUE 

NT  tt  OUHIO(NT,XSHIP) 

60  TO  200 
900  CONTXNUE 
RETURN 
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0002 

0003 

OOOO 

0003 

0006 


0007 

0000 
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0010 

0011 

0012 

0013 

0014 

0013 

0016 

0017 
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0020 
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0024 
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0034 
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SUBR0U71NE  UPDATE (NT, I3EC« I4*D« ISHI4,K) 

C  subroutine  UPOATE  goes  thru  the  list  of  ordered  detections  HHICH 
C  ARE  ASSOCIATED  MITH  TRACK  NT  AND  UPDATES  POSITION  AND  VELOCITY  OP 
C  NT  BASED  ON  THESE  DETECTIONS.  UPDATES  ARE  HADE  TO'TIHUP'NHICH  IS 

C  CURRENT  TIHE  LESS  SOHE  SPECIFIED  TIKE  LAC 

COMH0N/PLnT/IPLT(lO00),XX1(lOOO),VYY(t000),NP,VYN(iaoo),IVIS(IOO0) 
COMHON/KALS/  PS(20.20),PP(20,20),CBVS(20,20),COVK(20,20),XP(20) 
C0MHeN/KAL4/IFIRST(20.S),0IHl,DIK?,DIK3 
C0HHONyUPOATE/ILOC(2O),TIMLAG,TESTS(5l2.3),TLAST(256,S) 
C0KH0N/LtNK/LNKFSX,LNKSr6(2O,5),DUMST(S,20,5},TRKSr(20,20)«PTFST(2 
10.20).LNKID(20).TIHLNK(20,5),R0LLNK(20,S),PITLNK(20,5),SHDLNK(20,3 
2).XSH4(20,20i3).CRVSHO(io,10,2o,3>.PREC0V(i0,10,20,3).KPFlAG(20tS) 
CeHH0N/DETECT/XYZKS(2O.S,3,S).TH8(20,3,S),C0VHS(2n,S,3,3,5), 
lLSTBIN(6a,tOO,3.3),XS(20),TMPK(6a,3.3),TPATG(20),LNKRIN(20,3,S) 
COHHON/NEM/AZ(20,20),RG(20,20),EL(20,2A) 
COMHON/DATEUP/NUHTRG.NUhSHP 
C0HM0N/TRUE/XYZTRU(20.3,3,S) 

COMH6N/DETFIL/ICET(3.3).IOTA(236,3.3) 

INTEGER  TESTS, TRKST.PTFST,DIHt,DIH3,0IK3,0UKST,TRAT6,K.PFLAC 
Np  DIH2 

HT  •  TRKST(NT,ISHIP) 

C  K«000  INDICATES  UPDATE  OF  PARTICIPATING  PLATFORM 
IF(K.E0.  909)  GO  TO  80 
TIMUP  ■  TMR(<{isec,1RA0,I8HIP)  .  TIklAG 
DO  33  1*1, N 

X8(I)  ■  X8H0(I,KT,I8HIP) 

DO  33  Lal.N 

P8(I,L)  P  C0V8H8(1,L,MT,I8HIP) 

33  CONTINUE 
JPI 

10  CONTINUE 

ID  P  TE8T0(ILeC(J),l) 

IS  a  TE8T0(IL0C(J),2) 

IR  a  TE8TO(ItOC<J),37 
IT  4  I0T«(ID<IR,I9) 

C  IS  DETECTION  TINE  GREATER  THAN  TIMUP. 

IF(THS(ID,IR,I8).CT.TIkuP)  go  to  20 
X  a  XYZMS(IO,t,IR,IS) 

V  a  XYZH8(I0,2.IR,IS) 

Z  a  XYZHS(ID,3,IR,I8) 

TDEL  4  THa(IO,IR,IS)  •  TLAST(NT,ISHlP} 

IFdOHIP.EO.IS)  CO  TO  40 
CALL  COVLNK(IS,IO,IR,ISHIP) 

XT  a  X 
YT  4  Y 
ZT  a  Z 

ITT  4  XYZTRU(I0,1,IR,I8) 

YT)  a  XYZTRU(ID.2,IR.IS) 
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004«  ZTT  ■  XVZTRUdO.S.tn.lS) 

C  NOISY  STtOKIZED  COOf>eiN«TES  HtTH  RES^FCT  TO  ISMIR 
0041  CALL  TRANSF(XT.VT,ZT,K,V,Z,1SHIR,IS) 

C  TRUE  COORDINATES  MITH  RESRFCT  ISHIR 

0042  CALL  TRANSF(XTT.VTT.ZTT«XTRU.VTRU.ZTRU.ISNIR«IS1 

004S  GO  TO  SO 

0044  40  CONTINUE 

004S  XTRU  R  XY2TRU(I0»I,IR>I8) 

0040  TTRU  •  XVZTRU(I0,2,IR.1S) 

0047  ZTRU  •  XVZTRU(I0,3«1R>IS) 

0040  00  4S  I«1.3 

0040  DO  45  Lat.3 

0080  COVHd.L)  ■  COVRS(IO,I.L*lR.tS) 

0081  45  CONTINUE 

0052  50  CONTINUE 

0083  IF(IFIRST(nT, ISHIR). NE.O)  CO  TO  60 

0084  XR(1)  •  X 

0055  XR(2)  a  XSMOto.HT.ISHlR) 

0080  XR(3)  a  Y 

0057  XR(4]  a  X8Hn(4,HT.ISHlP) 

0050  XR(5)  a  Z 

0080  XR(0)  a  X8m0(6,hT, ISHIR) 

0000  60  CONTINUE 

0061  KFLAG  a  1 

0002  CALL  KALHAN(TOeL<*‘T.X.Y.Z. ISHIR. KFLAG. SO) 

0003  IRIRSTCHT. ISHIR)  a  IFIRST (HT. ISHIP)  .  1 

0004  1F(HRFLA6(HT, ISHIR). NE.O)  GO  TO  40 

0008  TLASTINT, ISHIR)  a  TH$(ID.tR,t8) 

0400  TIHLNKIHf, ISHIR)  a  THSIIO. IR. IS) 

OOOT  lORR  a  0 

0000  CALL  0CTLec(NT.lL9C(J).I0RR) 

0000  CALL  OCTORR(NT.ILSC(J)»ISHIR) 

0070  RRINT  300.TIhlnk{HT,I8H1P),IT,XTRU,YTPI:,ZTRU,IS 

0071  340  FSRRAT</I0X,F|0,3,5X,*TARGET«,I4,5X,'TRUE*.2X,3F)3.3,43X,15) 

0072  RRIN7  102. THRKCISEC.IRAD. ISHIR), X.y.Z 

0073  302  RORHAT<IOX,Flo,3,17X,'NOI8r*,2X,SFiS.3) 

0074  RRINT  S04.XS(l).X8(S).X8(5),X$C2).XS(4).XS(6) 

0078  304  RSRHAT(I6X,<SM0eTH>.2X,6Ft3.3//} 

0070  IFIIT.NE.I)  GO  TO  70 

0077  YYNINR)  a  Y 

0070  YVY(NR)  a  xS(3) 

0070  XXI  (NR)  a  TIHLNK  (*>Y,  ISHIR) 

0080  ms  (NR)  a  IS 

0001  NR  a  NR*1 

0002  lO  CONTINUE 

C  ARE  TNERE  MORf  OETECTIONS  YO  BE  CONSIDERED, 

0003  IRiJ.EQ.K'  :9  TO  30 

0004  jajat 

0000  OS  TO  14 

0000  so  CONTINUE 
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C  IP  IT.  HAS  aeCN  HaRE  THAN  2  tECeNOS  aiNCE  The  cast  update  aF  A  SHIP 
C  IT  MILL  aE  UPDATED  T8  MITHIN  SnE  SECRND  AF  THE  SECT4R  CRASSINfi  TImc 
IFf (THRK(18EC.IRAD,I8HIP)-TLAST(NT,:SHIR)),LT.2)  ca  T8  «9« 

TIHl  ■  THRK(ISEC.IRAO.I8HIR).t. 

TOEL  ■  TIHI-TLASTCNT^ISHIP) 

IF(TOEL,LT.  1.)  C«  T8  999 
J  ■  laHlP 

K  a  MRFLAG(HT,|SKIP) 

CALL  aHPGENCTIHtfNUNSHF) 

CALL  SC8eRD(NUHTRG,NUMSHP,J) 

X  a  RG(K,J]*S1N(AZ(N,J))*CBS(EL(K.J)) 

V  a  RG(K,J)*caS(AZ(K,J))*CDS(EL(K,J)) 

Z  a  R6(K.JI*SIN(EL(K,J)) 

DO  as  lal,3 
DO  as  Lat.S 
CevH(I,L)  a  O.I 
as  CONTINUE 

cavM<i,n  a  too, 

C0VH(2,2]  a  too. 

COVH(J,3)  a  too. 

GO  TO  SO 
90  CONTINUE 

TLA8T{NT,ISH1P)  a  TlHl 
TImLNI<(MT,ISHIP)  a  TIMl 
60  TO  30 
20  CONTINUE 

IF(J.EQ.l)  GO  TO  999 
30  CONTINUE 
DO  3S  lal,N 

XSN0<I,NT,ISHIP)  a  XSd) 

00  SS  JMI.N 

COVSMO(I,J,MT,ISNtP)  a  PSd.J) 

PRECOVd.J.HT.ISHIP)  a  PPd.J) 

3S  continue 

IF(PPFLAGtMT,ISHIP>.NE,0)  GO  TO  180 
GO  TO  18S 
180  CONTINUE 

NSHIP  a  K.NUMTRC 

PRINT  301,TINLNI<(PT,ISNIPJ,NSHIP,X,Y,Z,ISHIP 
301  F0RNATd0X,FtO,3,7X,i8HIP',IO,3i<,  'TRUE',  2X,3F  13.3,  «3X,  IS) 
las  CONTINUE 
999  CONTINUE 
RETURN 
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